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1. INTRODUCTION 


Until relatively recently, all wind tunnel Magnetic 
Suspension and Balance Systems (MSBS) relied exclusively on 
analogue controllers, of rather standardized form, to stabilize 
and control the position and attitude of the suspended model 
(reference 1). In the mid 1970's, MIT began an investigation of 
the feasibility of converting the control system of their 6 inch 
MSBS to digital operation, though experimental work progressed 
only as far as a 1 degree of freedom benchtop demonstration 
(reference 2) . Later, the University of Southampton MSBS 
controller was progressively digitized and can now only be 
operated in that form, with no provision for analogue reversion 
(references 3,4). Around 1980, the AEDC 13 inch MSBS was 
relocated to NASA Langley Research Center (LaRC) and was 
subsequently turned over to NASA ownership. Commencing in 1984, 
this system, hereafter referred to as the NASA LaRC 13 inch MSBS, 
has been digitized, following fairly closely the methods explored 
at Southampton. 



Fig. 1.1 Typical block diagram of digitally controlled MSBS 

The original motives for investigation of digital MSBS 
controllers included : 

1) Incorporation of more advanced control algorithms. All 
MSBSs, including those operated with digital controllers, have 
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utilized broadly similar control strategies. There is no reason 
to believe that these strategies represent the best performance 
that can be achieved and it is strongly felt that design, 
implementation, testing and evaluation of new algorithms will be 
far easier within a digitized controller than otherwise. Advanced 
control strategies are likely to include some self-adaptive 
features. 

2) Model changes. Controller coefficients (loop gains etc.) 
generally need to be reset or readjusted for each substantially 
different test model. This function is most easily implemented 
via accessing different software modules, rather than by 
mechanical or electrical adjustments. 

3) Performance repeatability. Digitized controller sections do 
not suffer from drift, electrical interference etc. , and retain 
accurate calibrations over unlimited time periods. 

4) Versatility of model position and attitude selection. 
Automatic, pre-programmed or operator driven real-time control of 
model position, attitude and motion has already been achieved 
with an ease which analogue systems could never approach. 

5) Data acquisition. Certain system data (model position, 
attitude and motion) is inherently available within the 
controller. Particularly when dynamic testing or rapid sequencing 
of model position or attitude is envisaged, the high level of 
synchronization required between the data acquisition and control 
functions recommends the complete integration of those functions. 
Further, it is anticipated that advanced algorithms would demand 
a tightly coupled flow of information between the controller and 
data processing functions (reference 5) . 



Fig. 1.2 Conceptual block diagram of advanced controller 
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Development of a comprehensive suite of control software was 
initially undertaken by Bouchalis and Fortescue (reference 3) , 
who achieved full 6 component control of winged models. Their 
software was later entirely re-written in a more modular form by 
this author. The software detailed in this report is essentially 
a second re-write, being modified to eliminate certain 
shortcomings of previous versions and to incorporate some more 
sophisticated features. A general comparison of the three suites 
is given in the following Table: 


I (Bouchalis, Fortescue) 

5/6 degree of freedom 
Traditional algorithms 
Limited attitude, 
motion scheduling 
No operator display 
No real-time 

data acquisition 


II 

5/6 degree of freedom 
Traditional alg. 
Comprehensive att., 
motion scheduling 
No operator display 
Some real-time 
data acquisition 


III 

5/6 deg. of freedom 
Traditional alg. 
Comprehensive att. , 
motion scheduling 
Some display 
Some real-time 
data acquisition 


All software so far written has been implemented using 
dedicated minicomputers, though on two slightly different 
configurations of same : 


III (NASA/AEDC 13") 


I, II (Southampton University) 

PDP 11/34A CPU (see later note) 
Extended Instruction Set 
FP-11 Floating point processor 
28k words memory utilized 
KW-11 programmable clock 
Custom built A/D and D/A 
subsytem accessed via 
single DR-11 digital I/O 
RT-11 V4.0 operating system 
MACRO V4.0 and FORTRAN V2 . 1 
application software 


PDP 11/ 2 3 -PLUS CPU 
Extended Instruction Set 
FPF-11 Floating point processor 
28k words memory utilized 
KW-11 programmable clocks 
AAV- 11 and ADV-11 A/D and D/A 
converters 
DRV- 1 1 digital I/O 
RT-11 V5.0 operating system 
MACRO V5.0 and FORTRAN V2 . 6 
application software 


Due to the extensive commonality of the PDP-11 family, both 
in hardware and software, conversion of software from one 
configuration to another is relatively straightforward. 

The current software is structured in a highly modular form 
in order to simplify the task of incorporating any amendments 
necessary to accommodate different test models, experimental set- 
ups or run-time features. Wherever possible, repetitious or 
common coding is accessed via simple calls to Subroutines or 
MACRO library modules. 

Considerable efforts have been made to streamline program 
execution since CPU speed is the major limiting factor with 
presently available computer hardware. At the loop repetition 
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rates chosen at Southampton (typically 400 cycles per second) , 
the hardware had been pressed close to its limit. Occasionally, 
with special features such as high angle-of -attack operation, 
computations extended beyond the available 1/400 secs, forcing 
reductions in loop rate. The NASA LaRC 13" MSBS can operate at 
lower loop repetition rates (typically 256 cycles per second) due 
to its larger size, hence lower system natural frequencies, but 
still has little spare CPU capacity since the PDP 11/23 is 
marginally slower than the 11/34. Certain desirable real-time 
features, particularly trapping of out-of-range or operator error 
conditions, are therefore not presently practical. 


tT -1— . n _ ... . - X. — — . tt J J J ■ TNTN T«* "1 "» / ^ TNT T !_ _ 

; ouuuicunpLUii unj.vtjx. sii.y ■ ss rur n/ j tru nas 

upgraded to a PDP 11/84, other hardware remaining 
unchanged. This represents a substantial increase 
speed . 


now been 
essentially 
in execution 
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2. CONTROLLER CONCEPTS 


Discussion in the remainder of this report will concentrate 
specifically on the controller hardware and software for the 
NASA LaRC 13" MSBS, though many details are common to the 
Southampton University system. 


2.1 CONTROL ALGORITHMS 

The block diagram of the controller, illustrated in 
Fig. 2.1., corresponds to normal MSBS practice although various 
alternative orderings of the blocks are possible. The ordering 
shown is presently found to be the most convenient for digital 
operation. 



Fig. 2.1 Functional block diagram of controller 

The pre-filter and translator serve mainly to permit the 
control algorithms to operate in model degrees of freedom, this 
being thought to be the best approach. The levels of model 
suspension stiffness and stability that can be achieved are 
principally affected by the parameters and performance of the 
phase advance block. Dual series phase advance (lead-lag) stages 
have been widely used in this application (see reference 1) and 
are retained in the digital controller pending provision of any 
superior alternatives. The digital implementation of these stages 
is detailed in the following Section, although, due to the high 
stage gain at high frequencies, these algorithms are viewed as 
being rather unsuited to digital implementation. Nevertheless, 
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the qualitative performance, with regard to suspension stiffness 
and stability, of the two digitized controllers operated to date 
is virtually indistinguishable from the best that their analogue 
counterparts could achieve. 



Integrators Loop gain 


Fig. 2. 2 Idealized controller transfer functions 

The controller transfer functions are shown in Fig. 2. 2. and 
may be implemented digitally as follows : 

Prefilter 

Algebraic combination of available position sensor 
data to provide measures of model position and attitude in model 
axes . 

Phase advance 

Configured in a dual series arrangement in the classical 
fashion : 


u 

1+nTD 

Z 

1+nTD 

d p- 


1+TD 


1+TD 



- where n,T presently have the same value in each stage. 
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This is implemented digitally as follows : 



Approximating for a discrete-time sampled-data system with sample 
interval At, we have : 


Ay 

T = u-y 

At 


with Ay = y(k)-y(k-l) 


Thus : At T 

y (k) ru u(k) + Y(k-l) 

T+At T+At 


This differs from the formulation given in reference 3 but 
is felt to be more appropriate at low sampling rates (At T) . 
Now following reference 3 : 


AY nT 

z = y + nT Giving : z(k) = y(k) + (y (k) -y (k-1) ) 

At At 


The above procedures are easily repeated by using z(k) as 
the input (u'(k)) to the second controller block.lt is seen that 
storage of one intermediate value (y(k-l)) is required for each 
block of the controller. It happens that slight savings in 
execution time can be made if the transfer function blocks are 
rearranged and a modified form of the first intermediate value 
stored : 
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y(k) 


T 

— — (u ' (k)+y(k-l)) 
T+A± 


At 

u' (k) = u(k) 

T 


The leading multiplier terms of the two blocks are now 
consolidated into a single operation : 



Additional gain terms can be agglomorated into the initial 
multiplier if desired. 

Offsets and gains 

Straightforward algebraic adjustments. 

Integrator 


u K 

^ D 



y(k) ^ u (k) 



u (n) At 


n=-oo 


If the value of KAt is relatively small (typically 2*10~ ) 
it may be chosen somewhat arbitrarily, with no significant effect 
on controller stability. This has been the usual case. 


2.2 SOFTWARE BLOCK STRUCTURE 


A relatively complex structure for the executable program 
has evolved which seems to provide an appropriate framework for 
the required functions. The program is entered and exited through 
FORTRAN for convenience. In order to preserve sufficient memory 
capacity for storage of real-time data, the executable program 
uses overlays (handled by RT-11) so that surplus code areas can 
be written over by the real-time portion of the controller, as 
shown in Fig. 2. 3. This real-time portion is structured in four 
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layers, as shown in Fig. 2. 4. 


MSBS.FOR 

(Root segment - Data arrays) 

DATIN 

TTON 


START 

USERIO 

CNTROL 


DATOUT 

TTOFF 


Resident segment 


Overlay segment 


Fig .2. 3 Control software overlay structure 

"MSBS" performs the necessary system-level software 
initialization (automatically) . Storage areas for oscillator, 
preprogrammed command, real-time (keyboard) command and acquired 
data arrays are reserved. All other program functions are handled 
by Subroutines which are called in sequence from MSBS. 

"DATIN" reads preprogrammed routine data from a disc 
datafile and fills the oscillator array with one cycle of a 
sinewave. 


"TTON" performs some system hardware initialization and sets 
up a screen display on the VT-102 console terminal. 

"START" accesses data across the FORTRAN "CALL" interface 
and sets up certain hardware features, notably the programmable 
clock rate and interrupt status. Some hardware features are reset 
prior to exiting the real-time controller, including reset of all 
D/A channels to safe (zero current) values. These reset functions 
are also performed following certain run-time error conditions, 
prior to returning to the system monitor. 

"USERIO" constitutes the only run-time interface between the 
console CRT/keyboard and the controller software. User commands 
are decoded, with some commanded functions performed directly and 
others routed via the user command array "CHARS". 

This module is interrupted (by the programmable clock) 
whenever the module " CNTROL" is required to run. Execution of 
"USERIO" resumes after completion of each control loop, but only 
until interrupted again. Interrupts repeat at 256 cycles per 
second (presently) , thus a rather small percentage of processor 
time is spent executing this module. 

"CNTROL" preserves the system state following the hardware 
interrupt, permitting return to the previously executing code in 
"USERIO". All real-time controller, data acquisition and related 
I/O functions are performed with the previous system state being 
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restored prior to return to "USERIO" . 

"TTOFF" resets the VT-100 screen display. 

"DATOUT" writes real-time data to a disc datafile if 
required. 

Two library modules are employed to simplify program 
coding. "CONFIG" provides system hardware configuration 
information and the fixed global assignments for elements of the 
command array CHARS. "CNTRLB" provides MACRO • s for all real-time 
I/O functions and for many controller functions repeated for each 
model degree of freedom. 


2.3 DATA ARRAY FORMAT 

The array CHARS is the medium by which run-time commands are 
transmitted to the controller and real-time data made available 
for inspection. The format of the array, summarized below, is 
crucial to the program structure and coding. Array addressing is 
based on use of ASCII numerical equivalents, with each array 
element effectively labelled with an ASCII character. It should 
be noted that the array is a subset of the ASCII code set. 


Element ASCII Element ASCII Element ASCII 

offset char. offset char. offset char. 


1 

0 

1 

SP 

1 

1 

32 

1 

§ 

1 

1 

64 

1 

1 


1 

1 

I 

1 

• 

1 

1 

33 

1 

A 

1 

1 

65 

1 

a 


1 

2 

1 

II 

1 

1 

34 

1 

B 

1 

1 

66 

1 

b 


1 

3 

I 

# 

1 

1 

35 

1 

C 

1 

1 

67 

1 

c 


1 

4 

I 

$ 

1 

1 

36 

1 

D 

1 

1 

68 

1 

d 


1 

5 

| 

% 

1 

1 

37 

1 

E 

1 

1 

69 

1 

e 


1 

6 

| 

& 

1 

1 

38 

1 

F 

1 

1 

70 

1 

f 


1 

7 

I 

1 

1 

1 

39 

1 

G 

1 

1 

71 

1 

g 


1 

8 

I 

( 

1 

1 

40 

1 

H 

1 

1 

72 

1 

h 


1 

9 

1 

) 

1 

1 

41 

1 

I 

1 

1 

73 

1 

i 


1 

10 

1 

* 

1 

1 

42 

1 

J 

1 

1 

74 

1 

j 


1 

11 

I 

+ 

1 

1 

43 

1 

K 

1 

1 

75 

1 

k 


1 

12 

1 

/ 

1 

1 

44 

1 

L 

1 

1 

76 

1 

1 


1 

13 

1 


1 

1 

45 

1 

M 

1 

1 

77 

1 

m 


1 

14 

1 

• 

1 

1 

46 

1 

N 

1 

1 

78 

1 

n 


1 

15 

1 

l 

/ 

1 

1 

47 

1 

0 

1 

1 

79 

1 

o 


j 

1 

16 

1 

0 

1 

1 

48 

1 

P 

1 

1 

80 

1 

P 


1 

17 

I 

1 

1 

1 

49 

1 

Q 

1 

1 

81 

1 

q 


1 

18 

I 

2 

1 

I 

50 

1 

R 

1 

1 

82 

1 

r 


1 

19 

| 

3 

1 

1 

51 

1 

S 

1 

1 

83 

1 

s 


1 

20 

| 

4 

1 

1 

52 

1 

T 

1 

1 

84 

1 

t 


1 

21 

| 

5 

1 

1 

53 

1 

U 

1 

1 

85 

1 

u 


1 

22 

| 

6 

1 

1 

54 

1 

V 

1 

1 

86 

1 

V 


1 

23 

| 

7 

1 

1 

55 

1 

W 

1 

1 

87 

1 

w 


1 

24 

1 

8 

1 

1 

56 

1 

X 

1 

1 

88 

1 

X 
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25 

1 

9 



26 

1 

• 

• 



27 

1 

• 

t 



28 

1 

< 



29 

1 

= 



30 

1 

> 



31 

1 

7 




57 

1 

Y 



58 

1 

Z 



59 

1 

[ 



60 

1 

\ 



61 

1 

] 



62 

1 

A 



63 

1 





89 

1 

y 



90 

1 

z 



91 

1 

{ 



92 

1 

I 



93 

1 




94 

1 

~ 



95 

1 

DEL 



Element offsets are (ASCII 8 ~40 8 ) or (ASCII 10 ~32 10 ) 

Since CHARS is a word array, the byte offset is twice the 
element offset. It is often convenient, therefore, to code 
references to specific array elements in the following form : 

CHARS+<2*110> o = CHARS+<2*72 . >- n = Address element 72, ASCII "h" 

o _L U 

Each element of CHARS corresponds to a command value, real- 
time data value, program control switch or similar. Full details 
of the assigned functions of each element are given in Section 4, 
but as an example, the contents of element 33 (ASCII A) are 
interpreted as the loop gain of the axial degree of freedom. The 
contents of all elements may be inspected at run-time from the 
keyboard, but only elements 32 and above may be modified by 
keyboard commands. Any element may be modified by a preprogrammed 
routine, dealt with later in this Section. 

The OSCILL array is loaded at run-time with a single cycle 
of a sinewave, amplitude 16,383 units, calculated at l/1024th 
of a cycle increments. With the program loop rate as 256 Hz, the 
minimum usable frequency is 0.25Hz, with frequencies of any 
multiple of 0.25 Hz being available. 


Element Contents 


OSCILL 


1 

2 

3 

4 


16383*Sin (0) 

16383*Sin (1*360/1024) 
16383*Sin (2*360/1024) 
etc. 


1022 | 

1023 j 16383*Sin (1022*360/1024) 

1024 j 16383*Sin (1023*360/1024) 


(angles in 
degrees) 


A master counter (ASCII , CHARS element offset 94 1Q ) is 
set up to tick once per program cycle (256 ticks/second) , 
resetting to 0 on every 1024th tick, and provides a reference 
phase and frequency of oscillator. The run-time variable 
frequency and phase feature is implemented by the following 
addressing procedure : 
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OSCILL address = [ (Master counter* Frequency) + Phase] 

(Truncated to first 10 bits) 

The ICOMM array contains preprogrammed position, attitude 
and motion command data. Four independent routines, each of up to 
80 individual commands, may be utilized, with options for fewer 
routines of greater length, up to the total command limit of 320. 
The format of the array is as follows : 


1st routine 


2nd routine 


3rd 


4 th 


Element 1{ | 

{ I 

(1st 2 { | 

command) { | 
3 { I 
I 

(2nd 4 { | 

command) { j 
5< I 


Duration | 


Value | 


Code 


Duration | 

1 

etc. I 


(3n+l) { | Terminator | 

(I 1 


240(| Duration | 480{| 

{) 1 (| 

241{| Value | (| 

{ I 1 (I 

242{| Code | (| 


720(| | 

(I 1 

( I I 

(I 1 


A terminator (Duration=0) is 
usually present, otherwise execution 
proceeds to the next available 
instruction, such as the 1st command 
of the second routine. 

The 1st routine may thus contain 
the 2nd, and so on. 


239 { | 


There is no restriction on access to the CHARS array from a 
preprogrammed routine (contrasting with restricted access from 
the keyboard) but certain keyboard functions do not operate : 

ESC The controller can only be aborted from the keyboard 
? Real-time data cannot be displayed automatically 
DEL Not required 


2.4 I/O Filtering 

If analogue position sensors, or analogue data-links from 
the position sensors, are used, then some form of analogue 
filtering is necessary at the controller A/D inputs. This 
corresponds to classical anti-aliasing filtering, though it is 
not yet clear whether the anti-aliasing function per se is 
particularly necessary for MSBS controller operation. Typical 
controller sampling frequencies have been at least a factor of 10 
above any natural frequency of the suspended model and the 
systems overall response falls very rapidly with increasing 
frequency. Rather, the filtering acts to limit high frequency 
noise at the controller inputs, since the conventional control 
algorithms exhibit high stage gain at high frequencies. The 
NASA LaRC 13" MSBS now has digital datalinks from inherently 
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digital self -Scanning Photodiode Array position sensors to the 
controller and appears not to require any form of input 
filtering. The frequency content of the position sensor 
information is naturally limited, of course, by the sampling 
processes inherent in the position sensor operation. 

Modest analogue filtering of the output demands to the 
electromagnet power supplies (via D/A convertors) appears to be 
advisable to avoid problems with conventional thryistor 
power amplifiers, notably the "beating" of the controller 
repetition frequency with the fundamental or harmonics of the 
thryistor firing frequency. This can be achieved by roll-off of 
the frequency response of the power supply preamplifiers. 
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3. SYSTEM CONFIGURATION 


A schematic diagram of the 13" MSBS laboratory is shown as 
Fig. 3.1, with a block diagram of the MSBS hardware as Fig. 3. 2. 
Some clarification is necessary. 

The peripheral processor (KXT-11C) is installed but not 
presently utilized. The intended function is to serve as an 
intelligent interface to wind tunnel instrumentation in order to 
make available real-time tunnel data, such as Mach number. 

Several different types of electromagnet power supply are in 
use, presently all on a temporary basis. Some power supplies have 
internal current feedback and their inputs can thus be regarded 
as current demand. The thyratron power supplies in use with the 
main electromagnets have no internal feedback and should thus be 
regarded as having a voltage demand input. 


3.1. POSITION SENSORS 

Model position data is acquired from five linear photodiode 
arrays, each of 1024 elements, illuminated by laser light sheets. 
The general principles of the system are shown in Fig. 3. 3. and 
Reference 7 gives more details of its operation. The output from 
the processing electronics is in the form of parallel 10-bit 
words, the value of each word corresponding to the number of 
photodiodes illuminated above some threshold level. Presently, 
the 1024th element is ignored. Synchronization of position sensor 
"scans" with the digital controller is important and is achieved 
in the following way. The (KWV-11C) clock signal which triggers 
the interrupt for initiation of the controller software loop also 
causes a "start scan" trigger to the position sensors. By placing 
the position sensor data input routines immediately after the 
interrupt (at the head of each controller loop) , acceptably tight 
synchronization is achieved, with no possibility of erroneous 
data, for all usable position sensor scan times. The hardware 
arrangement is shown in Fig. 3. 4. and the system timing diagram as 
Fig. 3. 5. Port assignments for sensor data are shown as Fig. 3. 6. 


3.2. ISOLATION AMPLIFIERS and ELECTROMAGNET CURRENT MONITORING 

Electromagnet currents are monitored using conventional 
shunts, via a purpose-built isolation amplifier system. Each 
amplifier can be adjusted for gain, offset and first-order filter 
characteristics. Outputs from the current shunt amplifiers are 
monitored by 12-bit A/D converters (ADV-11C) . The isolation 
amplifiers are also used as the interface between the PDP 11/23+ 
and the electromagnet power supplies. A complete separation of 
electrical grounds is thereby achieved. This is desirable for 
safety reasons and for the avoidance of earth-loop interference. 

A schematic diagram of the overall arrangement is given as 

Fig. 3. 7. and isolation amplifier channel assignments are shown as 

Fig. 3 . 8 . 
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Fig. 3.1. Schematic diagram of 13 " MSBS laboratory 





Main 
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Block diagram of 13” MSBS hardware 









Fig. 3. 3. Schematic diagram of position sensor system (2 channels) 


Position sensor system 


PDP 11/23+ 


"Start Scan" 
(To all channels) 


5 * 10 bits 
parallel 
digital data 

(1 * 10 bits per 
channel) 


T 



Interrupt to 
Software 


Fig. 3. 4. Position sensor interface schematic 
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KWV-1 1C 


PDP-1 1 
Software 

Position 

Sensors 




Data from scan (n— 1) 


Data (n) 
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DRV— 1 1 J 


PDP 11/23+ 


Digital data— link 


Opto-isolatorsl 


Position 

sensors 


Sensor ground 


Unit 1: Amplifiers 7-12 


ADV-11C 

( 2 ) 


5 (of 8) D/A lines 


Pwr S.1 


Power supply' 
ground 


9 (of 16) A/D lines 


ADV-11C 

( 2 ) 



From shunts 


Pwr S.2 


Computer 
analogue and 
digital ground 


Unit 1: Amplifiers 1-6 
Unit 2: Amplifiers 1—12 


Fiq.3.7. PDP 11/23, position sensor and i solation ampli fier system 
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Unit 1 


1 

3 

5 

7 

9 

11 

A/D 2.3 

A/D 2.5 

A/D 2.7 

D/A 1 
Cntrl 1 

D/A 3 
Cntrl 3 

D/A 5 
Drag 

2 

4 

6 

8 

10 

12 

A/D 2.4 

A/D 2.6 

A/D 2.8 

D/A 2 
Cntrl 2 

D/A 4 
Cntrl 4 

D/A 6 


Unit 2 


1 

3 

5 

7 

9 


A/D 1.1 
Drag 

A/D 1.2 
Bias 1 

A/D 1.4 
Bias 3 

A/D 1.6 
Cntrl 1 

A/D 1.8 
Cntrl 3 

A/D 2.3 
* 

2 

4 

6 

8 

10 


A/D 2.2 

A/D 1.3 
Bias 2 

A/D 1.5 
Bias 4 

A/D 1.7 
Cntrl 2 

A/D 2.1 
Cntrl 4 

A/D 2.4 
* 


Amp no. 

PDP I/O 
Function 


A/D channel numbers are Board. Channel 

D/A channel numbers are Channels, across 3 boards 


All A/D amplifiers fed from Power Supply 2 
All D/A amplifiers fed from Power Supply 1 


Fig. 3. 8. Isolation amplifier channel assignements 
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3.3. PDP 11/23+ 


Some relevant details of the hardware and software configuration 
are given below: 

CPU - PDP 11/23 PLUS with FPFll floating point processor 

Operating system - RT11 V5.0 

Languages - FORTRAN V2.6, MACRO V5.0 

User I/O devices - VT102 CRT, LA100 printer, HP7475 plotter 

Real-time I/O - 16/32 A/D channels (differential/single ended) 

12 D/A channels 
64 digital I/O lines 

Clocks - 2 programmable 

Serial I/O - 6 lines (console, printer, plotter, 3 spare) 

Memory - 256kB (only 56kB normally available for real-time 

software) 


I/O module addresses (relevant to digital controller) 


Module 

Function 

Address 

& Vector (octal) 


Console CRT serial line 

177560 

60 

KXT-11C 

Peripheral processor 

160100 


KWV-11C 

Programmable clock (No.l) 

170400 

440 

KWV-11C 

(No. 2) 

170420 

450 

ADV-11C 

A/D convertors (Board 1) 

170430 

400 

ADV-11C 

(Board 2) 

170440 

420 

AAV- 11C 

D/A convertors (Board 1) 

170450 


AAV- 11C 

(Board 2) 

170460 


AAV- 11C 

(Board 3) 

170470 


DRV- 1 1 J 

64-line Digital I/O 

164160 

Prog. 
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4. CONTROLLER USERS GUIDE 


4.1 HARDWARE OPERATION 

4.1.1 STARTUP 

POWER UP PDP 11/23 AND TERMINALS 

Switch on CRT (Switch at lower left side) 

Switch on printer (Switch at lower left rear) 

Set printer ON LINE (Keyboard key) 

Check HALT switch up on PDP CPU (Automatic system bootstrap) 
Raise PWR switch on PDP CPU (PWR and RUN lights come on) 

(Bootstrap message on CRT) 

LOAD disc drives (Drives 0 and 1) 

Wait for READY lights on both 


LOAD SYSTEM SOFTWARE 

Respond to CRT bootstrap message : 

Type : DL<Ret> 

(System software loads) 

(Startup message appears on CRT) 
(Enter date, eg. 5,24,86) 

RT-11 is now running, as indicated by the DOT (" .") prompt. 
(Power up MSBS INTERFACES and POSITION SENSORS if required) 


4.1.2 CLOSEDOWN 

Release disc LOAD switches 

Wait for LOAD lights to come on 

Lower PWR switch on PDP CPU 
Switch off CRT and printer 


4.2 CONTROLLER SOFTWARE OPERATION 

4.2.1 ACTIVATE CONTROL PROGRAM 

When all relevant hardware is powered-up, the control 
software can be started, with the MSBS in almost any status 
(model in/ out etc.). 

Type: RUN MSBS<Ret> 


(READY lights extinguish) 
(IMPORTANT) 
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Response: ACCESSING DATA FILES 


(Controller is reading 
preprogrammed routines, 
zeroizing data stores and 
loading the oscillator 
array) 

Run-Time CRT display appears, showing title 
message, command reminders, etc. 


4.2.2 RUN-TIME SCREEN DISPLAY 

The VT-102 screen display initializes in broadly the 
following format: 


NASA LaRC 13 inch MAGNETIC SUSPENSION and BALANCE SYSTEM 


| Axial | 

X 

i 

a i 

r 

1 

A 

1 

( 

) 

Integrators* ( 

) 

| Lateral | 

Y 

i 

b j 

s 

1 

B 

1 

( 

) 

Drag Int.*( 

) 

[Vertical j 

z 

i 

c k 

t 

1 

C 

1 

( 

) 

Outputs* ( 

) 

j Pitch | 

m 

i 

e p 

V 

1 

E 

1 

( 

) 



1 Yaw | 

n 

i 

f q 

w 

1 

F 

1 

( 

) 

Auto routine 



<Screen area A> <area B> <area C> 


<Cursor initializes here> 


Screen area A provides "memory joggers" for some of the most 
commonly used keyboard command codes. The first column (x-n) 
shows codes for the usual steady position or attitude commands, 
the next three columns show codes for oscillator amplitudes, 
frequencies and phases respectively, with the last column showing 
loop gain codes. 

Screen areas B and C are updated only when <Ret> is entered 
at the keyboard, with the latest available data. Area B shows the 
measured model position and attitude in each degree of freedom, 
in units of raw counts from the position sensors. This data 
serves mainly as a check when powering up and launching. Area C 
shows the state of various program switches, either ON or OFF and 
the number of the preprogrammed routine presently loaded (see 
Section 2.3). The integrator switches are forced OFF and the 
integrator accumulators are cleared (set to zero) when the output 
switch is OFF. Otherwise the accumulator values are preserved. 

The lower portion of the display scrolls conventionally, 
echoing commands and data entered from the keyboard, or 
displaying real-time data (via the ? command) . 

There is typically no external evidence that the controller 
is executing correctly, though a spare D/A channel can be used to 
output a square wave of frequency equal to the loop rate for test 
purposes. Detection of this signal is a reliable indication that 
the software is at least looping correctly (hardware interrupt 
driven) . Run-time checks would, however, only normally be 
necessary following major software amendments. 
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4.2.3 RUN-TIME KEYBOARD COMMANDS 


Communication between operator and system (via CRT/keyboard) 
is handled exclusively by the real-time software, therefore great 
care must be exercised by the operator/programmer. 

Since lower case command codes correspond to the usual run- 
time commands, the CAPS LOCK key of the CRT should normally be 
released (up) . 


***************************************************************** 
************ TYPING ERRORS ARE LIKELY TO CAUSE ************ 

************ LOSS OF CONTROL OF A SUSPENDED MODEL ************ 

***************************************************************** 

Certain controller functions are accessible in real-time 
from the keyboard. In addition, some real-time data may be 
examined via the CRT, though not amended by keyboard input. All 
functions are commanded in a similar format : 

(Number) (-) (CODE LETTER) <Ret> 

Parameters in curved brackets are optional. Note carefully that 
the (optional) minus sign is trailing , the same format being used 
for all screen displays. The function of the CODE letters is 
explained in the following table : 

CODE ASCII 

letter (octal) Function and comments 

Special characters 


ESC 

033 

Abort program 

- 

055 

Minus sign (must trail value) 

♦ 

077 

Query data 

DEL 

177 

Delete present input line (line is cleared) 

Ret 

N/A 

Enter command (Update screen) 


Examine 

data. Read only (from keyboard) , preceded by ? 

SP 

040 

AL position sensor data 

1 

# 

041 

AX 

II 

042 

AU 

# 

043 

FU 

$ 

044 

FL 

% 

045 

Unassigned. Reserved for position sensor data 

& 

046 

X position data 

1 

047 

Y 

( 

050 

Z 

) 

051 

L orientation data 

* 

052 

M 

+ 

053 

N 

t 

054 



055 

«Minus sign» 
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/ 

0 

1 

2 

3 

4 

5 

6 

7 

8 
9 


< 

> 

•? 


056 

057 
060 
061 
062 

063 

064 

065 

066 
067 

070 

071 

072 

073 

074 

075 

076 

077 


Remaining number of data sweeps 
Reserved for electromagnet 
current data 


Ramp vector 
Ramp increment 


<<Query contents of array location» 


§ 

A 

B 

C 

D 

E 

F 

G 

H 

I 

J 

K 

L 

M 

N 

0 

P 

Q 

R 

S 

T 

U 

V 
W 
X 

Y 
Z 
[ 

\ 

] 


100 

101 

102 

103 

104 

105 

106 
107 
110 
111 
112 

113 

114 

115 

116 
117 
120 
121 
122 

123 

124 

125 

126 
127 

130 

131 

132 

133 

134 

135 

136 

137 


Data input. Read/write from keyboard 

Upper case codes 


X (axial) loop gain 
Y (lateral) 

Z (vertical) 

L (roll) 

M (pitch) 

N (yaw) 

Load preprogrammed routine (0-3) 


L Auxiliary displacement 

M 

N 


X Auxiliary displacement 

Y 

Z 

Data acquisition flag (number of sweeps) 
Output flag (0=Off, otherwise On) 
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tiiQt) o 3 g h **«-»• h- troj M) (o a o tr o> 


s 

t 

u 

V 

w 

X 

y 

z 

{ 

I 

I 

} 


140 

141 

142 

143 

144 

145 

146 

147 

150 

151 

152 

153 

154 

155 

156 

157 
160 
161 
162 

163 

164 

165 

166 
167 

170 

171 

172 

173 

174 

175 

176 


DEL 177 


Lower case codes 

X oscillator amplitude (Unspecified 

Y oscillator amplitude units) 

Z oscillator amplitude 

L oscillator amplitude 

M oscillator amplitude 

N oscillator amplitude 

Automatic routine flag (number of repeats) 
Integrator switch (0=off, otherwise on) 

X oscillator frequency (Units of 

Y oscillator frequency 0.25 Hz) 

Z oscillator frequency 

L orientation (Unspecified units) 

M orientation 
N orientation 

L oscillator frequency (Units of 
M oscillator frequency 0.25 Hz) 

N oscillator frequency 
X phase (Units of 360/1024 degrees 

Y phase in LEAD relative to ref.) 

Z phase 

L phase 
M phase 
N phase 

X position (Unspecified units) 

Y position 
Z position 


Master oscillator counter (ticks of l/256th 
second, reset to 0 on 1024th tick) 

«Cancel input line» Also spurious data sink 


Quick reference table for normal runtime (lower case) commands 


1 


1 

X 

Y 

z 

1 

L 

M 

N 

1 

1 

Position 

1 

X 

y 

z 

1 

1 

m 

n 


1 

Osc. amp. 

1 

a 

b 

c 

1 

d 

e 

f 

1 

1 

Freq. 

1 

i 

j 

k 

1 

o 

P 

q 

1 

1 

Phase 

1 

r 

s 

t 

1 

u 

V 

w 

1 


] = Outputs on/off 
H = Drag integrator on/off 
g = Auto routine (no. repeats) 
ESC = abort program 


h = Main integrators on/off 
[ = Data acquisition (no. sweeps) 
DEL = delete input (line clears) 
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Other functions 


1 



X 

Y 

Z 

1 

L 

M 

N 

1 

1 

Loop 

gain j 

i 

A 

B 

C 

1 

D 

E 

F 

1 

1 

Aux. 

1 

disp. | 

X 

Y 

Z 

1 

L 

M 

N 

1 


All numerical keyboard I/O takes place in INTEGER DECIMAL format. 


Examples 


3000A <Ret> 
1000-m <Ret> 

20 [ <Ret> 
h <Ret> 


- sets axial (drag) gain to 3000 

- calls for small negative pitch 
displacement 

- takes burst of 20 data sweeps 

- turns off integrators 


?( 


- causes display of last Z (heave) 
model position sample 


Note that ? , DEL or ESC do not require the usual <Ret> terminator 


4.2.4 Launch and landing sequences 
Launch 


With control software activated and most MSBS systems 
powered-up (NOT "CONTROL" or "BIAS" or "DRAG" supplies) a 
sequence of operations to launch the model might be: 

1) Activate BIAS supplies and set to desired current 

2) Activate CONTROL currents and DRAG current. No significant 
currents should flow in any controlled coil. 


3 ) Type 

4 ) Type 

4 ) Type 

5) Type 


50002 <Ret> 
1] <Ret> 
z <Ret> 

lh <Ret> 

1H <Ret> 


(commands system to suspend model very low, 
roughly corresponding to its position on 
the model launcher) 

(turns outputs ON, small control currents 
begin to flow, model is now under partial 
control) 

(commands model to lift to datum position. 
Offset settings in the program usually 
result in insufficient current to actually 
lift the model) 

(turns position error integrators ON. Model 
will now rise positively to the desired 
position and orientation) 
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Landing 

1) Type ] <Ret> (turns output currents OFF, model drops onto 

grabbers, integrators turn OFF) 

2) Turn off CONTROL and DRAG power supplies 

3) Turn off BIAS currents 

4) Abort control program ("ESC") 


4.3 LIMITATIONS and RESTRICTIONS 


Data acguisition 


The limited direct memory addressing capability of PDP-11 
computers (32kW (kWords) ) , together with the overhead of the I/O 
page (4kW) , the vector table (320W) and RT-11 (varies between 2kW 
and 5KW depending on monitor type and configuration) , leaves 
rather restricted memory available for real-time data. In fact 
the overlayed structure of the controller program (Section 2.2) 
is employed solely to free as much memory as possible. 
Nevertheless, only around 12000 words of real-time data storage 
can normally be made available, corresponding to 12000 data 
samples. With a number of samples being taken per program loop 
(typically at least 14 samples = 5 positions/attitudes + 9 
currents) , the maximum number of data "sweeps" is given by : 

S = 12000/14 = 857 (approx) 

At 256 program cycles per second, this is in turn equivalent 
to less than 3.3 seconds of real-time data. Data can be taken in 
several bursts at any interval up to the maximum number of sweeps 
shown above. Data overflow is prevented by repetitively 
overwriting, when necessary, the last set of valid data 
locations. Otherwise the program would attempt to write to 
sequential memory locations beyond the data array, eventually 
corrupting other program code. 

The short-term solution to the memory problem is seen as 
invoking RT-11 Memory Management instructions to access Extended 
Memory in real-time. On a PDP 11/23 up to around 2000kW of such 
memory may be installed. The coding necessary to implement access 
is certainly feasible, but by no means trivial. 

Control Algorithms 

Existing control algorithms are rather unsophisticated and 
are long overdue for replacement. 

Prefilter and translator 


As presently structured, these modules can implement a fixed 
linear relationship between input and output, eg. : 
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(Axial position) (abode) (AL) 

( Lateral pos.) (f g . ) (AX) 

( Vertical pos.) = ( ) (AU) “(Prefilter) 

(Pitch attitude) ( etc. ) (FU) 

( Yaw attitude) ( ) (FL) 

and: 


(E/M 

1 

demand) 

(1 m n o 

p) (Vertical demand) 


(E/M 

2 

demand) 

(q r . 

) (Pitch demand 

) 


(E/M 

3 

demand) 

= ( 

) (Lateral demand ) 

- (Translator) 

(E/M 

4 

demand) 

( 

) (Yaw demand 

) 


(E/M 

5 

demand) 

( 

• « « a 

) (Axial demand 

) 



The 13" MSBS is inherently non-linear. For instance, the 
vertical magnetic force, below the point of saturation of the 
model's core, will vary as the square of the "vertical" current 
(a sum of currents in the four main E/Ms) . If this peculiarity is 
to be accomodated, much more elaborate translator coding will be 
necessary. The present coding might be regarded as a piecewise 
linear approximation, valid for small perturbations about the 
selected datum position/orientation and force/moment level. The 
effects of variations in the force/moment level, such as between 
wind-on and wind-off test points, can be partially accomodated by 
re-trimming loop gains (from the operator's keyboard) . This is, 
in fact, a technique that was used extensively by MIT with their 
6" MSBS for somewhat similar reasons. 

If suspension over a wide range of positions and/or 
attitudes is contemplated, then the inevitable variation of 
translator coefficients (particularly with attitude) due to the 
nature and behaviour of the magnetic field gradients will have to 
be taken into consideration. This issue is very complex (see 
Ref .6) . 

Similarly, the variation of prefilter coefficients with 
model position and/or attitude (particularly attitude) would need 
to be taken into consideration for large excursions from the 
datum to be possible. Analysis is relatively more straightforward 
here however, being dependant exclusively on system geometry. 
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APPENDIX A 


COMPILATION, ASSEMBLY AND LINKING OF EXECUTABLE PROGRAM 

A total of 44 files are involved in the creation of the 
executable program; 10 source code files, 12 command files, 2 
library files, 8 object modules, 9 listing or map files, 2 run- 
time datafiles and finally the executable program file itself. 

Table A.l lists all the file names and functions. Table A. 2 
illustrates the complete procedure for creation of the executable 
program. Refer to the source code listings in Appendix B. 


TABLE A.l FILENAMES AND FUNCTIONS 
FILENAME FUNCTION and COMMENTS 


Source code files : 


MSBS . FOR FORTRAN root 

DATIN.FOR Data input/load Calls MSBS . DAT at run-time 

DATOUT . FOR Data output/store Creates DATA . DAT at run-time 


TTON. MAC 

Initialize (display) 

Requires 

CONFIG. MLB 

TTOFF. MAC 

De-initialize 

If 


START . MAC 

Startup module 

If 


USERIO.MAC 

User I/O module 

If 


CNTROL.MAC 

Controller module 

- and 

CNTRLB.MLB 

CONFIG. MAC 
CNTRLB. MAC 

Configuration library 
Real-time I/O library 

source 

source 



Command files : 


MSBS.COM 
DATIN . COM 
DATOUT . COM 
TTON . COM 
TTOFF . COM 
START . COM 
USERIO.COM 
CNTROL.COM 
MSLINK.COM 


Command file for MSBS. FOR compilation 
-for compilation of DATIN.FOR 
-for compilation of DATOUT. FOR 
-for assembly of TTON. MAC 
-for assembly of TTOFF. MAC 
-for assembly of START. MAC 
-for assembly of USERIO.MAC 
-for assembly of CNTROL.MAC 
-for linking of MSBS.SAV 


MSDBG.COM 


-expanded functions of CNTROL.COM for debugging 


CNTRLB.COM Command file to create CNTRLB.MLB library 

CONFIG.COM -to create CONFIG. MLB library 


Numerous temporary or auxiliary files are created during the 
compilation, assembly and linking processes : 


CONFIG. MLB MACRO library modules 

CNTRLB . MLB 
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MSBS.OBJ 
DATIN.OBJ 
DATOUT . OBJ 
TTON . OBJ 
TTOFF.OBJ 
START. OBJ 
USERIO . OBJ 
CNTROL. OBJ 

Object modules 


MSBS . LST 

narpTM T.C'T' 

L/itO. Xil • JU 

DATOUT . LST 
TTON . LST 
TTOFF . LST 
START. LST 
USERIO. LST 
CNTROL. LST 
MSBS. MAP 

Compiler listing files 
Assembler listing files 

Linker map file 


2 run-time datafiles are required or created : 

MSBS . DAT 
DATA . DAT 

Preprogrammed model motions (required) 
Acquired real-time data (created/ overwritten) 

The final executable program file is : 

MSBS.SAV 

Executable program, calls MSBS . DAT, creates 
DATA . DAT at run-time. 

TABLE A. 2 MODULE COMPILATION, ASSEMBLY 

and LINKING 

Command files 

are activated under RT-11 

by entering: 

0FILNAM 

<Ret> -where .COM is 

the default extender 

CREATE LIBRARIES 


Command file 

Input module 

Output module 

CONFIG (.COM) 
CNTRLB (.COM) 

CONFIG. MAC 
CNTRLB . MAC 

CONFIG. MLB 
CNTRLB . MLB 

ASSEMBLE MACRO MODULES 


Command file 

Input modules 

Output modules 

TTON (.COM) 
TTOFF (.COM) 

TTON. MAC, CONFIG. MLB 
TTOFF. MAC, CONFIG. MLB 

TTON . OBJ , TTON . LST 
TTOFF . OBJ , TTOFF . LST 
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START (.COM) 
USERIO (.COM) 
CNTROL (.COM) 

START. MAC, CONFIG. MLB 
USERIO. MAC, CONFIG. MLB 
CNTROL. MAC, CNTRLB. MLB, 
CONFIG. MLB 

START. OBJ, START. LST 
USERIO. OBJ, USERIO. LST 
CNTROL. OBJ, CNTROL. LST 

MS DBG (.COM) 

CNTROL. MAC, CNTRLB. MAC, CNTROL. OBJ, CNTROL. LST 
CONFIG. MLB 

(MS DBG includes full MACRO expansions) 

COMPILE FORTRAN MODULES 


Command file 

Input modules 

Output modules 

MSBS (.COM) 
DATIN (.COM) 
DATOUT (.COM) 

MSBS . FOR 
DATIN. FOR 
DATOUT . FOR 

MSBS. OBJ, MSBS. LST 
DATIN. OBJ, DATIN. LST 
DATOUT. OBJ, DATOUT. LST 

LINK OBJECT MODULES 


Command file 

Input modules 

Output modules 

MS LINK (.COM) 

MSBS. OBJ, DATIN. OBJ, 
DATOUT. OBJ, TTON.OBJ, 
TTOFF . OBJ, START. OBJ, 
USERIO. OBJ, CNTROL. OBJ 

MSBS.SAV, MSBS. MAP 

Each command 

file (compilation, assembly 

or linking process) 


should be activated only when an input module to that file 
(process) is modified. For example, if CNTRLB . MAC is altered 
(edited) , the procedure to generate a revised executable program 
would be : 

@ CNTRLB 

@ CNTROL 

0MSLINK 


<Ret> -generate revised library 

<Ret> -reassemble modules that 

utilize CNTRLB routines 
<Ret> -relink executable program 
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APPENDIX B 


SOURCE CODE 
MSBS . COM 

DATIN.COM 

DATOUT.COM 

TTON.COM 

TTOFF . COM 

START . COM 

USERIO.COM 

CNTROL.COM 

MSLINK.COM 

MSDBG.COM 

CONFIG.COM 

CNTRLB.COM 


LISTINGS 


FORT/ LIST: MS BS /WARN MSBS 


FORT/LIST : DATIN/WARN DATIN 


FORT/ LI ST : DATOUT/ WARN DATOUT 


R MACRO 

TTON , TTON=CONFIG/M , TTON 
A C 


R MACRO 

TTOFF , TTOFF=CONFIG/M, TTOFF 
A C 


R MACRO 

START , START*=CONFIG/M , CNTRLB/M , START 
A C 


R MACRO 

USERIO , USERIO=CONFIG/M, USERIO 
A C 


R MACRO 

CNTROL, CNTROL=CONFIG/M, CNTRLB/M, CNTROL 
A C 


R LINK 

MSBS , MSBS=MSBS/ C 
DATIN ,TT0N/0: 1/C 
DATOUT , TTOFF/ 0 : 1/C 
START , USERIO , CNTROL/O : 1 


R MACRO 

CNTROL, CNTROL/L:ME=CONFIG/M, CNTRLB/M, CNTROL 
A C 


LIBRARY/MACRO CONFIG CONFIG 


LIBRARY/MACRO CNTRLB CNTRLB 
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non ooo non non 


MSBS . FOR 


DIMENSION I SC ILL ( 1024 ) , IC0MM( 960 ) , IDATA ( 12020 ) , ICHARS ( 96 ) 

FETCH DISC DATAFILES, FILL ARRAYS, INITIALIZE VT100 

CALL DATIN ( ISCILL , ICOMM , IDATA , ICHARS ) 

CALL MAIN CONTROL PROGRAM 

CALL START ( ISCILL , ICOMM , IDATA, ICHARS ) 

RESET VT100 , STORE DATAFILES IF REQD. 

CALL DAT0UT( IDATA) 

FINISHED 

STOP 

END 


DATIN . FOR 


SUBROUTINE DATIN ( ISCILL, ICOMM, IDATA, ICHARS ) 

DIMENSION ISCILL! 1024 ) , ICOMM! 960 ) , IDATA ( 12020 ) , ICHARS ( 96 ) 
DIMENSION IDUM( 40) 

LOGICAL* 1 ICHAR 
C 

C READ IN PREPROGRAMMED ROUTINE 
C 

TYPE 10 

10 FORMAT (' ACCESSING DATA FILES' ) 

OPEN ! UNIT- 1 . NAME* ' MSBS . DAT ' , TYPE* ' OLD ' FORM* ' FORMATTED ' f 
1REC0RDSIZE*61 > 

DO 15 1=1,960 
15 ICOMM( I ) *0 

DO 35 1-1,100,3 

20 READ( 1,30 ,END=38) ICOMM(I) ,IC0MM(I+1) , ICHAR, ( IDUM(J) ,J*1,40) 

30 FORMAT! 2 1 8 , 2X , A1 , 2X , 4 0A2 ) 

C 

C CONVERT LETTERS TO ARRAY ADDRESS 
C 

35 ICOMM ( 1+2 ) = ( ( ICHAR-32 )*2) 

38 CL0SE(UNIT=1 ) 

C 

C END OF READ IN. CALCULATE SINE WAVE 
C 

PI*3. 141592654 
DO 40 1*1,1024 
X=PI*FLOAT( 1-1 ) /512 . 0 
40 ISCILL( I ) *INT( 32767 . *SIN(X) ) 

C 

C ZEROISE DATA STORAGE 
C 

DO 50 1=1,12020 

50 IDATA( I ) =0 
DO 51 1=1,96 

51 ICHARS ( I ) =0 
C 

C SET UP SYSTEM LOOP GAINS 
C 

ICHARS! 34 >=12000 
ICHARS! 35 >=7500 
ICHARS! 36 >=7500 
ICHARS! 38 >=3500 
ICHARS! 39 >=3500 
ICHARS! 16 >=850 
C 

C CALL VT100 INITIALIZING ROUTINE 
C 

CALL TTON 
C 

C DONE HERE 
C 

RETURN 
END 


1 AXIAL GAIN 
| LATERAL GAIN 
(VERTICAL GAIN 
(PITCH GAIN 
(YAW GAIN 

1MAX. NUMBER OF DATA SWEEPS 
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DATOUT . FOR 


SUBROUTINE DATOUT ( IDATA) 

DIMENSION IDATA( 12020) 

C 

C CALL VT100 RESET ROUTINE 
C 

CALL TTOFF 
C 

C SAVE DATA? 

C 

TYPE 70 

70 FORMAT < ' CONTROLLER ABORTED, DATA TO FILES? <1*YES, 0=N0)') 

READ( 5,*) NSAVE 
IF(NSAVE.NE.l) GO TO 80 
C 

C OUTPUT SOME DATA 
C 

TYPE 90 

90 FORMAT ( ' DATA BEING STORED' ) 

OPEN (UNIT- 2, NAME* 'DATA.DAT' , TYPE* 'NEW' , FORM* ' UNFORMATTED ' , 

1 RECORDS I ZE*1 ) 

DO 100 1=1,12000 
100 WRITE (2) IDATA(I) 

CLOSE (UNIT*2) 

C 

80 CONTINUE 

RETURN 
END 
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TTON . MAC 


.TITLE TTON 


; PROGRAM TITLE 


>+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 
; Purpose: TTON peforms some system initialization and sets up the VT-102 

t 

; Environment: Executes once only 


; Related modules: 

; Data I/O: None 

9 

t Variables: None 


Called from and returns to DATIN 


.MCALL CONFIG 

; 

; FETCH I/O DEVICE ADDRESSES 
{ 

CONFIG 


{TURN OFF SOME SYSTEM INTERRUPTS 


; CONFIGURATION MACRO 
{ SYSTEM CONFIGURATION AND DEFINITIONS 


TTON:: BIC #1OO,0#TKS 

MOV #O,0#LCLK 

{ 

i SETUP FLOATING POINT PROCESSOR 

SETI 

SETF 

> 

; SETUP DIGITAL I/O PORTS 

CLR 0#CSRA 

CLR 0#CSRB 

CLR 0#CSRC 

CLR @#CSRD 


.-INHIBIT KEYBOARD INTERRUPTS 
; DISABLE LINE CLOCK INTERRUPTS 


;SET SHORT INTEGERS 

{SET SINGLE PRECISION FLOATING MODE 


{PORT A STATUS REGISTER 
{PORT B 
{PORT C 
{PORT D 


{DISPLAY ROUTINE - Set up initial VT-102 screen display. Uses XON/XOFF 
{ protocol to control rate of character output 



MOV 

#BUFF1 ,R0 

{FETCH ADDRESS OF OUTPUT STRING 

FETCH: 

MOVB 

(R0)+,R1 

{FETCH NEXT CHARACTER 


BEQ 

DONE 

{JUMP OUT IF TERMINATOR (ASCII NULL) 

TEST: 

T3TB 

0#TPS 

{IS PRINTER INTERFACE READY? 


BPL 

TEST 

{WAIT IF NOT 


MOVB 

R1 ,0#TPB 

{OUTPUT CHARACTER 


TSTB 

0#TKS 

{HAS CRT SENT A CHARACTER? 


BPL 

FETCH 

{CONTINUE (IGNORE IT) IF NOT 


MOVB 

0#TKB,R2 

{FETCH CHARACTER IF AVAILABLE 


CMPB 

#23, R2 

{IS THIS AN XOFF? 


BNE 

FETCH 

{CONTINUE IF NOT 

XONi 

TSTB 

0#TK3 

{HAS CRT SENT AN XON? 


BPL 

XON 

{WAIT FOR ONE IF NOT 


MOVB 

Q#TKB,R2 

{FETCH CHARACTER 


CMPB 

#21, R2 

,-MAKE SURE IT IS AN XON 


BNE 

XON 

{KEEP WAITING IF NOT 


BR 

FETCH 

{RESUME OUTPUT IF IT WAS XON 

DONE: 

RTS 

PC 

{RETURN TO CALLING MODULE 


{ 

{BUFFI description: 
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;Line 

; Lines 

;Line 

;Llnes 

;Lines 

;Llne 

jLine 

;Line 

luFFl: 


Is Set scrolling area (lines 11-24), move cursor to top/left home 

2-3: Title in reverse video 

4: Define alternate character set (accessed by SI /SO) 

5-16: Memory Jogger bloclc 

17-19: Switch display block 

20: Auto routine display block 

21: Move cursor to top of scrolling area 

22: String terminator 

.ASCII <33>/Cll;24r/<33>/C2J/<33>/CH/<33> 

.ASCII /C7m NASA Langley Research Center 13 inch MAGNETIC / 

.ASCII /SUSPENSION and BALANCE SYSTEM /<33>/Cm/ 

.ASCII <33>/ ) 0/<33> / (B/ 

. ASCII < 33 > / C3 f 1H/ < 16> / 1 qqqqqqqqqqwqqqwqqqqqqqwqqqk / < 17> < 15> < 12> 
.ASCII <16>/x/<17>/ Axial /<16>/x/<17>/ x /<16>/x/<17>/ air/ 

.ASCII <16>/x/<17>/ A /<16>/x/<17X15><12> 

.ASCII <16>/x/<17>/ Lateral /<16>/x/<17>/ y /<16>/x/<17>/ b J s / 

.ASCII <16>/x/<17>/ B /<16>/x/<17X15X12> 

.ASCII <16>/x/<17>/ Vertical /<16>/x/<17>/ z /<16>/x/<17>/ c k t / 

.ASCII <16>/x/<17>/ C /<16>/x/<17X15X12> 

.ASCII <16>/x/<17>/ Pitch /<16>/x/<17>/ m /<16>/x/<17>/ e p v / 

.ASCII <16>/x/<17>/ E /<16>/x/<17X15X12> 

.ASCII <16>/x/<17>/ Yaw /<16>/x/<17>/ n /<16>/x/<17> / f q w / 

.ASCII <16>/x/<17>/ F /<16>/x/<17X15X12> 

.ASCII < 16> /mqqqqqqqqqqvqqqvqqqqqqqvqqq J / < 17 > 

.ASCII <33>/C4;45HIntegrators*/ 

.ASCII <33>/C5;47HDrag Int.=/ 

.ASCII <33>/C6;49H0utputs=/ 

.ASCII <33>/C8;45HAuto routine/ 

.ASCII <33>/Cll;lH/ 

.ASCII <0> 

.END 
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TTOFF . MAC 


.TITLE TTOFF ; PROGRAM TITLE 

+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 
Purpose: TTOFF performs some system and all VT-102 deinitialization 

Environment: Executes once only 

Related modules: Called from and returns to DATOUT 

Data I/O: None 

variables: None 


.MCALL CONFIG ? CONFIGURATION MACRO 

FETCH I/O DEVICE ADDRESSES 

CONFIG {SYSTEM CONFIGURATION AND DEFINITIONS 

DISPLAY ROUTINE - Resets VT-102 screen display. Uses XON/XOFF protocol 


TTOFF: : 

MOV 

#BUFF1,R0 

FETCH: 

MOVB 

<R0)+,R1 


BEQ 

DONE 

TEST: 

TSTB 

<3#TPS 


BPL 

TEST 


MOVB 

R1,0#TPB 


TSTB 

0#TKS 


BPL 

FETCH 


MOVB 

0#TKB,R2 


CMPB 

#23, R2 


BNE 

FETCH 

XON: 

TSTB 

8#TKS 


BPL 

XON 


MOVB 

0#TKB,R2 


CMPB 

#21, R2 


BNE 

XON 


BR 

FETCH 


{RESTORE SOME SYSTEM INTERRUPTS 


DONE: 

BIS 

#1OO,0#TK3 


BIS 

#1OO,0#LCLK 

{ 

RTS 

PC 

BUFFI: 

.ASCII 

<33>/Cl{24r/ 


.ASCII 

<33>/C24{lH/ 

{ 

.ASCII 

<0> 

.END 



{FETCH ADDRESS OF OUTPUT STRING 
{FETCH NEXT CHARACTER 
{JUMP OUT IF TERMINATOR (ASCII NULL) 
{IS PRINTER INTERFACE READY? 

{WAIT IF NOT 

{OUTPUT CHARACTER 

{HAS CRT SENT A CHARACTER? 

{CONTINUE IF NOT 

{FETCH CHARACTER IF AVAILABLE 

{IS THIS AN XOFF? 

{CONTINUE IF NOT 
{HAS CRT SENT AN XON? 

{WAIT FOR ONE IF NOT 
{FETCH CHARACTER 
{MAKE SURE IT IS AN XON 
{KEEP WAITING IF NOT 
{RESUME OUTPUT IF IT WAS XON 


{RESTORE KEYBOARD INTERRUPTS 
{RESTART LINE CLOCK 


{Set whole screen scrolling 
{Cursor to bottom line 
.•String terminator 
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USERIO.MAC 


.TITLE USERIO 


; PROGRAM TITLE 



; Purpose: USERIO handles all real-time keyboard input and CRT output 


t Environment: Executes continuously, unless interrupted by hardware. No CRT 

; handshaking employed, the rate of character output assumed to 

; be slowed by repeated interruption of execution 

• 

; Related modules: System hardware interrupts are initialized by START, 

; CNTROL executes once per hardware interrupt 

; 

; Data I/O: All I/O takes place via the command array CHARS 

9 

; Variables: CHARS array specified seperately. MASK is used to block 

; certain illegal repeated Inputs, only Bits 0-2 used: 

; Bit 0 - Numeric value received from keyboard (0*No, l*Yes) 

? 1 - Implicit or explicit sign received 

; 2 - Code letter received 


• 

. GLOBL 

CHARS, COMMAN 

;DATA AND COMMAND ARRAYS 

9 

• 

.MCALL 

CONFIG 

; REQUIRED MACROS 

jFETCH 

• 

SYSTEM CONFIGURATION 


r 

• 

CONFIG 


: SYSTEM CONFIGURATION AND DEFINITIONS 

; INPUT 

CHARACTER FROM KEYBOARD AND VECTOR TO ROUTINES 

USERIO: 

: JSR 

PC, FETCH 

FETCH INPUT CHARACTER 


CMP 

#177, RO 

DELETE? 


BEQ 

DELETE 

GO TO DELETE HANDLER IF DELETE 


CMP 

#100, RO 

LETTER? 


BMI 

LETTER 

GO TO LETTER HANDLER IF LETTER 


CMP 

#77, RO 

QUERY? 


BEQ 

QUERY 

GO TO QUERY HANDLER IF QUERY 


CMP 

#71, RO 

LOOK FOR SOME ILLEGAL CHARACTERS 


BMI 

USERIO 

GO BACK IF ILLEGAL 


CMP 

#57,R0 

NUMBER? 


BMI 

NUMBER 

GO TO NUMBER HANDLER IF NUMBER 


CMP 

#55, RO 

MINUS? 


BEQ 

MINUS 

GO TO MINUS HANDLER IF MINUS 


CMP 

#15, RO 

CARRIAGE RETURN? 


BEQ 

RETURN 

GO TO CARRIAGE RETURN HANDLER 


CMP 

#33,R0 

ESCAPE? 


BNE 

USERIO 

GO BACK SINCE ALL HERE ARE ILLEGAL 

ESCAPE: 

RTS 

PC 

(EXCEPT ESCAPE) RETURN TO START MACRO 


DELETE - Clear screen input line and data 

FETCH ADDRESS OF LINE BLANKER 
DO IT 

ZEROISE KEYBOARD INPUT 
KEYBOARD LETTER STARTS AS DELETE 
CLEAR INPUT MASK 
BACK TO START 

9 

i LETTER HANDLER - Store legal letter code 


DELETE: MOV #0UT11,R2 

JSR PC , OUTSTR 

CLR KEYNUM 

MOV #177,KEYLET 

CLR MASK 

JMP USERIO 
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LETTER: BIT #4, MASK 

BNE USERIO 

BIS #7, MASK 

JSR PC,PRINSC 

SUB #40, RO 

ASL RO 

MOV RO,KEYLET 

JMP USERIO 


ONLY ONE LETTER ALLOWED 

OTHERWISE BACK TO START 

WE HAVE LETTER, BLOCK NUMBER /SIGN 

ECHO CHARACTER 

CONVERT TO ARRAY OFFSET 

CONVERT TO W ORD ADDRESSING 

STORE LEXTER CODE 

JUMP BACK TO START 


; 

; MINUS - Negate present Input value 


MINUS: BIT *6, MASK 

BNE USERIO 

JSR PC,PRINSC 
NEG KEYNUM 

BIS #2, MASK 

JMP USERIO 


CHECK IF ACCEPTABLE 
JUMP OUT IF NOT 
ECHO CHARACTER 
NEGATE KEYBOARD INPUT 
WE HAVE A SIGN 
DONE HERE 


I 

; NUMBER - Multiply up present Input value 


; 


NUMBER: BIT #6, MASK 

BNE USERIO 

BIS #1 ,MASK 

JSR PC,PRINSC 

SUB #60, RO 

MOV KEYNUM, R1 

MUL #10., R1 

ADD RO ,R1 

MOV R1 , KEYNUM 

JMP USERIO 


CHECK IF ACCEPTABLE 
JUMP OUT IF NOT 
WE HAVE NUMBER 
ECHO CHARACTER 

CONVERT RO TO ACTUAL NUMBERS 

FETCH PRESENT INPUT VALUE ACCUMULATOR 

INCREMENT EXPONENT 

ADD IN PRESENT DIGIT 

RESTORE KEYNUM 

GO BACK TO START 


r 

fQUERY ROUTINE - Input letter code to query then output relevant value to CRT 
; 


QUERY: 

BIT 

#7, MASK 


BNE 

USERIO 


JSR 

PC,PRINSC 

GET2: 

JSR 

PC, FETCH 


CMP 

#33, RO 


BEQ 

ESCAPE 


CMP 

#37, RO 


BPL 

GET2 


JSR 

PC ,PRINSC 


SUB 

#40, RO 


ASL 

RO 


MOV 

CHARS (RO) ,R0 


JSR 

PC ,DECOUT 


JSR 

PC, CARRLF 


JMP 

USERIO 


ACCEPT ONLY IF FIRST CHARACTER 

OTHERWISE BACK TO START 

ECHO CHARACTER 

GET ANOTHER INPUT CHARACTER 

ESCAPE? 

GO TO ESCAPE HANDLER IF YES 
LOOK FOR ILLEGAL CODE 
JUMP OUT IF ILLEGAL 
ECHO LEGAL CHARACTER 
CONVERT TO ARRAY OFFSET 
CONVERT TO WORD ADDRESSING 
FETCH QUERIED VALUE 
PUSH OUT DECIMAL VALUE 
OUTPUT CR/LF 
BACK TO START 


\ CARRIAGE RETURN - Output CR/LF, 

RETURN: MOV KEYLET,RO 

MOV KEYNUM, CHARS (RO) 
JSR PC , CARRLF 

CLR KEYNUM 

MOV #177,KEYLET 

CLR MASK 


then enter Screen Update section 

FETCH LETTER CODE 

LOAD KEYBOARD INPUT TO CHARS ARRAY 

OUTPUT CR/LF 

ZEROISE KEYBOARD INPUT 

KEYBOARD LETTER STARTS AS DELETE 

CLEAR INPUT MASK 


; 

;SCREEN UPDATE - Save cursor position before starting work on displays 


MOV #0UT1 ,R2 ; FETCH ADDRESS OF CURSOR SAVE 
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JSR 

PC, OUTSTR 

/DO IT 

/UPDATE POSITION DISPLAY - Pseudo real-time position sample display area 

CRSMOV: 

MOV 

#OUT2 ,R2 

FETCH ADDRESS OF CURSOR MOVE COMMAND 


JSR 

PC, OUTSTR 

DO IT 


MOVB 

OUT3,Rl 

FETCH CURSOR LINE NUMBER (START AT 4) 


SUB 

#60, R1 

CONVERT TO ACTUAL NUMBERS 


CMPB 

#6,R1 

ABOVE 6? (TRYING TO SKIP ROLL DATA) 


BPL 

DISPLC 

JUMP AROUND IF NOT 


INC 

R1 

SKIP 1 ARRAY ELEMENT FOR ROLL 

DISPLC: 

ASL 

R1 

CONVERT TO WORD ADDRESSING 


ADD 

#4,R1 

CONVERT TO ARRAY OFFSET 


MOV 

CHARS (R1),R0 

RO CONTAINS ARRAY VALUE TO OUTPUT 


JSR 

PC,DECOUT 

OUTPUT ARRAY VALUE 


MOV 

#0UT5,R2 

FETCH ADDRESS OF DUMMY SPACES 


JSR 

PC, OUTSTR 

PUSH OUT SPACES (TO MASK OLD NUMBERS) 


INCB 

0UT3 /INCREMENT LINE NUMBER COUNTER 


CMPB 

#70,0UT3 

IS IT PAST LAST LINE? (END AT 8) 


BPL 

CRSMOV 

LOOP BACK IF NOT 

LASTLN: 

• 

MOVB 

#64 , 0UT3 

RESET LINE NUMBER COUNTER (ASCII 4) 

/SWITCH 

• 

DISPLAY 

UPDATE - Program 

switch display area 

9 

MOV 

#0UT6,R2 

MOVE TO MAIN INTEGRATOR UPDATE 


JSR 

PC, OUTSTR 

DO IT 


MOV 

INTFLG,R0 

ARE MAIN INTEGRATORS ON? 


JSR 

PC, ONOFF j 

OUTPUT ON/ OFF MESSAGE 


MOV 

#0UT9 ,R2 

MOVE TO DRAG INTEGRATOR UPDATE 


JSR 

PC, OUTSTR , 

DO IT 


MOV 

DRGFLG,RO ; 

IS DRAG INTEGRATOR ON? 


JSR 

PC, ONOFF j 

OUTPUT ON/ OFF MESSAGE 


MOV 

#OUT10,R2 

MOVE TO OUTPUT UPDATE 


JSR 

PC, OUTSTR ; 

DO IT 


MOV 

OUTFLG,RO ; 

ARE OUTPUTS ON? 


JSR 

PC, ONOFF i 

OUTPUT ON /OFF MESSAGE 

/LOAD CORRECT AUTO ROUTINE and DISPLAY 

9 

TST 

AUTFLG 

IS A ROUTINE ALREADY RUNNING? 


BNE 

RSTORE 

IGNORE POSSIBLE REQUEST IF YES 


MOV 

AUTNUM,R1 

FETCH AUTO ROUTINE NUMBER 


BIC 

#177774, R1 

TRUNCATE ROUTINE NUMBER TO 0-3 


MOV 

R1,AUTNUM 

UPDATE ROUTINE NUMBER 


MUL 

#480., R1 

CONVERT TO BYTE ADDRESSING 


ADD 

COMMAN+4 ,R1 

ADD ADDRESS OFFSET 


MOV 

Rl,C0MMAN+2 

UPDATE 1ST ARCHIVE POINTER 


MOV 

R1,C0MMAN 

UPDATE RUN-TIME POINTER 


MOV 

#0UT12,R2 

MOVE TO AUTO ROUTINE NUMBER 


JSR 

PC, OUTSTR 

DO IT 


MOV 

AUTNUM,RO /FETCH AUTO ROUTINE NUMBER AGAIN 


JSR 

PC,DECOUT 

OUTPUT ROUTINE NUMBER 

RSTOREs 

MOV 

#0UT4,R2 

FETCH ADDRESS OF CURSOR RESTORE COMMAND 


JSR 

PC, OUTSTR 

DO IT 

DONE: 

JMP 

USER 10 

GO BACK TO START 


; SUBROUTINES - OUTSTR, DECOOT, ONOFF, FETCH, CARRLF, PRINSC 
/SUBROUTINE OUTSTR - Send stored ASCII string to CRT 
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OUTSTR: HOVB 

(R2)+,R0 

; FETCH FIRST CHARACTER 

BEQ 

ENDSTR 

; JUMP OUT IF TERMINATOR 

TEST2t TSTB 

0#TPS 

;IS CRT READY? 

BPL 

TEST2 

;WAIT IF NOT 

HOVB 

RO,0#TPB 

t OUTPUT CHARACTER 

BR 

OUTSTR 

;LOOP BACK FOR NEXT CHARACTER 

ENDSTRi RTS 

PC 

; RETURN FROM SUBROUTINE 


; SUBROUTINE DECOUT - Decode value in NUMBUF and send to CRT as ASCII numbers 


DECOUT: 

MOV 

NUMBUF, R2 


;GET ADDRESS OF NUMBER STORE 




TST 

RC 


; 15 THE VALUE NEGATIVE? 




BPL 

DIVIDE 


; JUMP IF NOT 




NEG 

RO 


i CHANGE 3IGN TO POSITIVE FOR OUTPUT 



MOVB 

#55, (R2)+ 


;PUSH MINUS INTO NUMBER STORE 



DIVIDE: 

MOV 

RO,Rl 


;PUSH VALUE DOWN TO LOW HALF OF DIVIDEND 


CLR 

RO 


; CLEAR HIGH HALF OF DIVIDEND 




DIV 

#10. ,R0 


; DIVIDE BY 10, REMAINDER IN R1 




ADD 

#60, R1 


; CONVERT TO ASCII 




MOVB 

R1,(R2)+ 


; STORE CHARACTER AS OCTAL BYTE 




TST 

RO 


;ARE WE DOWN TO ZERO YET? 




BNE 

DIVIDE 


;LOOP BACK IF ANY MORE DIGITS TO COME 



MOVB 

#40, (R2)+ 


;PUSH SPACE INTO NUMBER STORE 



NUMOUT: 

TSTB 

0#TPS 


; IS CRT READY? 




BPL 

NUMOUT 


;WAIT IF NOT 




MOVB 

- (R2 ) ,0#TPB 

.•OUTPUT CHARACTER 




CMP 

NUMBUF, R2 


; ARE HE DONE? 




BNE 

NUMOUT 


;LOOP BACK IF NOT 



» 

RTS 

PC 


; RETURN FROM SUBROUTINE 



} SUBROUTINE ONOFF - Send ASCII " 

9 

ON" or "OFF" to CRT depending on value 

In RO 

ONOFF: 

TST 

RO 


; SWITCH ON OR OFF? (0=OFF, OTHERS 

ON) 



beq 

OFF 


;GO TO OFF MESSAGE 



ON: 

MOV 

#0UT7,R2 


; FETCH ADDRESS OF OFF MESSAGE 




JSR 

PC, OUTSTR 


;DO IT 




RTS 

PC 


;DONE HERE 



OFF: 

MOV 

#0UT8,R2 


? FETCH ADDRESS OF ON MESSAGE 




JSR 

PC, OUTSTR 


;DO IT 




RTS 

PC 


;D0NE HERE TOO 



; SUBROUTINE FETCH - Input 

single character from keyboard, wait If 

none 

ready 

FETCH: 

TSTB 

0#TKS 


; IS CHARACTER READY? 




BPL 

FETCH 


;WAIT IF NOT 




MOVB 

0#TKB,RO 


; FETCH INPUT CHARACTER 




RTS 

PC 


; RETURN FROM SUBROUTINE 



; SUBROUTINE CARRLF - Send 

CR/LF 

combination to CRT 



CARRLF: 

TSTB 

0#TPS 


;IS CRT READY? 




BPL 

CARRLF 


jWAIT IF NOT 




MOVB 

#15,0#TPB 


•OUTPUT CR 



TEST: 

TSTB 

0#TPS 


;IS CRT READY? 




BPL 

TEST 


;WAIT IF NOT 




MOVB 

#12 ,0#TPB 


; OUTPUT LF 




RTS 

PC 


; RETURN FROM SUBROUTINE 



; SUBROUTINE PRINSC - Send 

(echo) 

ASCII value to CRT 



PRINSC: 

TSTB 

0#TPS 


; IS CRT READY? 
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) 

BPL 

MOVB 

RTS 

; 

NUMBUF: 

• BLKB 

KEYNUM: 

.WORD 

KEYLETs 

.WORD 

MASKi 

.WORD 

OUTli 

.ASCII 

0UT2 1 

.ASCII 

0UT3< 

.ASCII 

0UT4: 

.ASCII 

0UT5 » 

.ASCII 

0UT6 » 

.ASCII 

0UT7 : 

.ASCII 

0UT8t 

.ASCII 

0UT9 : 

.ASCII 

0UT10 : 

.ASCII 

OUTlls 

.ASCII 

0UT12 : 

.ASCII 

1 

.END 


PRINSC 

RO,0#TPB 

PC 


?WAIT IF NOT 
; OUTPUT CHARACTER 
; RETURN FROM SUBROUTINE 


10 

0 

177 

0 


•Dummy storage for values from query routine 

; Keyboard input value 

; Keyboard input letter, starts as DELETE 
; Input vectoring mask 


<33>/7/<0> 

<33>/C/ 

/4;30H/<0> 

<33>/8/<0> 

<40> <40> <40> <40><0> 
<33>/C4;57H/<0> 

/ON /<0> 

/0FF/<0> 

<33>/C5;57H/<0> 

<33>/C6;57H/<0> 

<33>/C2K/<15><0> 

<33>/C8;58H/<0> 


;Save cursor position 
; Start cursor move command 
;Move cusor to line *, column 30 
; Restore cursor position 
; Spaces for blanking previous value 
;Move cursor to INTEGRATOR* 

;ON message 
;0FF message 

;Move cursor to DRAG INT. * 
jMove cursor to OUTPUTS* 

; Blank present input line 
;Move cursor to AUTO ROUTINE 
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START. MAC 


.TITLE START 


Purpose : 


Environment: 


; PROGRAM TITLE 


Access data required by real-time code, initialize hardware 
interrupts, provide system error traps 

Executes once only, some system interrupts already disabled 
prior to module entry 


; Related modules: 
/ 


Called by MSBS, calls USERIO, with interrupt to CNTROL 
activated 


i Bata I / 0 : 


; 

f Variables: 

/ 


Accesses C3CILL, BATA, COMMAN and CHARS arrays from FORxkAN . 
CHARS array is copied to local version for faster real-time 
addressing. All arrays remain valid on exit 

ICHARS is FORTRAN CHARS array, CHARS is local CHARS copy 


. GLOBL CHARS, BATA, OSC ILL, COMMAN 

. MCALL . TRPSET , . EXIT , . PRINT 
. MCALL CONFIG , BFCHAR , OUTPUT 

; FETCH I/O BEVICE ADDRESSES 


;DATA ARRAYS 

; SYSTEM MACROS 
; CONFIGURATION MACRO 


CONFIG ; SYSTEM CONFIGURATION AND DEFINITIONS 

;SAVE DATA ACROSS FORTRAN CALLING INTERFACE 


; 


START: : 

TST 

(R5) + 

SKIP SUBROUTINE ARGUMENT COUNT 


MOV 

<R5)+,0SCILL 

STORE ADDRESS OF OSCILLATOR ARRAY 


MOV 

(R5) , COMMAN 

STORE ADDRESS OF COMMAND ARRAY 


MOV 

(R5) ,C0MMAN+2 

ARCHIVE COMMAND ARRAY ADDRESS 


MOV 

( R5 ) + , COMMAN+4 

TWICE 


MOV 

(R5) ,DATA 

STORE ADDRESS OF DATA ARRAY 


MOV 

(R5)+,DATA+2 

ARCHIVE ARRAY ADDRESS 

• 

MOV 

(R5)+, ICHARS 

STORE ADDRESS OF CHARS ARRAY 

/COPY ICHARS 

ARRAY TO LOCAL ARRAY CHARS 


r 

CLR 

R1 

CLEAR INDEX REGISTER 


MOV 

ICHARS.RO 

FETCH ADDRESS OF ICHARS ARRAY 

COPY* 

MOV 

( R0 )+, CHARS (Rl) 

COPY VALUE ACROSS TO CHARS ARRAY 


ADD 

#2 . ,R1 

INCREMENT CHARS ARRAY INDEX 


CMP 

#190. ,R1 

ARE WE AT THE LAST ELEMENT YET? 


BPL 

COPY 

LOOP BACK IF NOT 

•ACTIVATE RUN-TIME TRAP HANDLER 


r 

.TRPSET #EMTARG , #SRESET 

(CALL RT11 TRAP CATCHER 

/SET UP 

LOOP 

RATE CLOCK, WITH INTERRUPTS 

ENABLED 

r 

MOV 

#CNTROL , @#CL2V 

(SET UP NEW CLOCK VECTOR 


MOV 

#300 ,0#CL2V+2 

(PROCESSOR STATUS WORD FOR INTERRUPT 



/PROCESSOR RUNS AT PRIORITY 6 DURING 




(INTERRUPT 


MOV 

#170275, @#CL2B /CLOCK COUNTER IS 3906 (DEC.) COUNTS 


MOV 

#113 ,0#CL2S 

(SET CLOCK FUNDAMENTAL TO 1 MHZ 


;LOOP RATE IS 256 HZ 
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INTERRUPTS ENABLED 


CALL KEYBOARD HANDLER - CNTROL will interrupt in 1/256 seconds 


* 

JSR 

PC,USERIO 

(CALL TO USERIO, RETURN ON CLOSEDOWN 

CLSDWN: 

BIC 

#100 ,@#CL2S 

TURN OFF CLOCK INTERRUPTS 


CLR 

RO 

LOAD RO WITH ZERO CURRENT DEMAND 

* 

OUTPUT 

0 

KILL CHANNEL 0 


OUTPUT 

1 

AND 1 


OUTPUT 

2 

ETC. 


OUTPUT 

3 


« 

OUTPUT 

4 ; 


r 

CMP 

#340,@#PSW ; 

IS THIS A CLOSEDOWN OR A CRASH? 


BEQ 

ABNDN ; 

JUMP IF THIS IS A CRASH 


RTS 

PC ; 

RETURN TO FORTRAN IF NOT 

ABNDN: 

• EXIT 

• 

9 

SYSTEM CRASH 


SYSTEM SHUTDOWN WITH ERROR DETECTED 


SRESET: 

MOV 

#340,Q#PSW 

( RAISE PROCESSOR STATUS TO 7 


.PRINT 

#TRAPM 

;PRINT MESSAGE TO CRT 


BR 

.EXIT 

CLSDWN 

;JUMP TO CLOSEDOWN ROUTINE 

OSCILL: 

.WORD 

0 

ADDRESS OF OSCILLATOR ARRAY 

ICHARS: 

.WORD 

0 

COMMAND DATA ARRAY ADDRESS 

DATA: 

.WORD 

0,0 

ADDRESS AND ARCHIVE OF DATA ARRAY 

COMMAN: 

.WORD 

0,0,0 

ADDRESS OF PREPROGRAMMED ARRAY 

CHARS: 

• 

9 

.BLKW 

DFCHAR 

96. 

COPY OF COMMAND ARRAY DATA 

EMTARG: 

.WORD 

0,0 


TRAPM: 

. ASCIZ 
.END 

/ 7AB0RT - TRAPPED TO 4 OR 10?/ 
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CNTROL . MAC 


.TITLE CNTROL 


; PROGRAM TITLE 


l 

r 

; Purpose: 


CNTROL performs all real-time control and data acquisition 


« 

; Environment: Starts following clock interrupt, executes once, returns to 

• previously executing code 

; Related modules: USERIO is the module interrupted and returned to. Only 

; RO, R1 and R2 are preserved by CNTROL. 


; 

; Data I/O: 
? 


OSCILL contains sinewave data. DATA is used for sequential 
storage of real-time data. CHARS carries in keyboard commands 
in near real-time. COMMAN carries in preprogrammed routines. 


w 

i Variables: 
; 

9 

? 

9 

f 


OUTFLG is output on/off flag (0=off, otherwise on) 

INTFLG is main integrator flag (h) 

DRGFLG is axial integrator flag (H) 

DATFLG is data acquisition flag (C, number of sweeps) 

OVRFLW is number of data sweeps left before overflow 
S AMPL E is number of channels of real-time data (dummy var.) 
AUTFLG is number of auto routines to run (g) 

AUTNUM is loaded auto routine number (G) 


; 


. GLOBL CHARS, DATA, OSCILL, COMMAN 

.MCALL TRANSL, ROTATE, PHASEF, OUTPUT 
.MCALL INTEG,INTEG2,ADST,DAST 
. MCALL PREPRG , FLPFLP , 0UTPU2 , ADCLS 
.MCALL CONFIG, ADST2 ,ADCLS2 ,DIGSCN 

; INITIALIZE LABELS 


;DATA ARRAYS 


;AND REQUIRED MACROS 
; 

; 

; 


CONFIG ; SYSTEM CONFIGURATION 

SAMPLE* 0 ;SET DATA ACQUISITION CHANNEL COUNTER 


, 


; MAIN LOOP 

START, CALLED FROM CLOCK 

INTERRUPT 

CNTROL: :BIC 

#200 ,@#CL2S 

; CLEAR INTERRUPT FLAG OF CLOCK 

MOV 

R0,-(SP) 

;PUSH R0 

MOV 

R1,-(SP) 

; AND R1 

MOV 

R2,-(SP) 

; AND R2 

; CHANGE R6 

TO DATA STACK 


MOV 

SP, STACK 

.•ARCHIVE SYSTEM STACK POINTER 

MOV 

DATA , SP 

;SET UP DATA STACK 

• INCREMENT 

MASTER OSCILLATOR 


INC 

OSC 

; INCREMENT MASTER COUNTER 

BIC 

#176000, OSC 

; TRUNCATE COUNTER TO 10 BITS 


\ A.AAAAil.AAAA.iAAArAAA.A.AAAAAAA.A.A.A.AiAAtAA.iAAAAAAA.AAAA.AAA.AcArAil.AAA.AAA.AA.AAAAAA******* 

> COMPUTE MODEL POSITION AND ATTITUDE 

DIOSCN ;SCAN DIGITAL INPUT PORTS 

MOV AL.Rl : FETCH POSITION SENSOR DATA 
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MOV 

FL,R5 


MOV 

AU,R3 


MOV 

FU,R4 


MOV 

AX,R2 

•VERTICAL 



MOV 

#1777, RO 


SUB 

R5,R0 


SUB 

Rl,RO 


MOV 

R0,VERT 


DAST 

RO 

t PITCH 


MOV 

R5,R0 


SUB 

R1,R0 


MOV 

RO, PITCH 


DAST 

RO 

i LATERAL 



MOV 

#1777, RO 


SUB 

R3,R0 


SUB 

R4,R0 


MOV 

RO,LAT 


DAST 

RO 

YAW 


MOV 

R3,RO 


SUB 

R4,R0 


MOV 

RO , YAW 


DAST 

RO 

AXIAL 


MOV 

R2,R0 


SUB 

#777, RO 


ASL 

RO 


MOV 

RO, AXIAL 


DAST 

RO 


; LOOP RATE INDICATOR FLIP 


; 

FLPFLP 5,2000 


AL=AFT LEFT, FL=FORWARD LEFT 
AU=AFT UPPER, FU=FORWARD UPPER 
AX= AXIAL 


FETCH VERTICAL OFFSET (1023. PIXELS) 
SUBTRACT FL 
AND AL 

STORE VERTICAL POSITION 
STORE AS DATA 


FETCH FL 
SUBTRACT AL 
STORE PITCH ATTITUDE 
STORE AS DATA 


FETCH LATERAL OFFSET (1023. PIXELS) 
SUBTRACT AU 
AND FU 

STORE LATERAL POSITION 
STORE AS DATA 


FETCH AU 
SUBTRACT FU 
STORE YAW ATTITUDE 
STORE AS DATA 


FETCH AX 

SUBTRACT AXIAL OFFSET 

TIMES 2 FOR SIMILAR SENSITIVITY 

STORE AXIAL POSITION 

STORE AS DATA 


.-SETS CHANNEL 5 D/A TO -2.5V APPROX. 


f 

; COMPENSATOR, WITH INTERLEAVED DATA ACQUISITION 


; START A/D CHANNEL 0 

ADST 0 

'•VERTICAL 

PHASEF VERT, VT, 0.64, 17. 9, 3. 11 
TRANSL CHARS , OSCILL , 3 
MUL VG,R2 

INTEG CHARS, VINT 

MOV R2,VO 

; COLLECT A/D AND START NEXT 
ADCLS 
ADST 1 

\ PITCH 

PHASEF PITCH, PT, 0.64, 17. 9, 3. 11 


; CHANNEL 0 IS DRAG 


PHASE ADVANCE VERTICAL POSITION 
ADD IN USER DEMANDS 

VERTICAL GAIN. DROP LOW ORDER PRODUCT 
INTEGRATOR 

STORE VERTICAL DEMAND 


\ CHANNEL 1 IS BIAS 1 


; PHASE ADVANCE PITCH ATTITUDE 
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ROTATE CHARS , OSCILL , 2 
MUL PG,R2 
INTEG CHARS, PINT 
MOV R2,P0 

; COLLECT A/D AND START NEXT 
ADCLS 
ADST 2 

; LATERAL 

PHASEF LAT,LT,0.64,17.9,3. 11 
TRANSL CHARS, OSCILL. 2 
MUL LG.R2 
INTEG CHARS, LINT 
MOV R2.L0 

♦ 

.-COLLECT A/D AND START NEXT 
ADCLS 
ADST 3 

Jyaw 

PHASEF YAH, YT, 0.64, 17. 9, 3. 11 
ROTATE CHARS, OSCILL, 3 
MUL YG.R2 
INTEG CHARS, YINT 
MOV R2 ,Y0 

; COLLECT A/D AND START NEXT 
ADCLS 
ADST 4 

; AXIAL 

PHASEF AXIAL, AT, 0.64, 17. 9, 3. 
TRANSL CHARS, OSCILL, 1 
MUL AG,R2 
INTEG2 CHARS, AINT 
MOV R2 ,A0 

; 

; COLLECT A/D AND START 
ADCLS 
ADST 5 


ADD IN USER DEMANDS 
PITCH GAIN 
INTEGRATOR 
STORE PITCH DEMAND 


; CHANNEL 2 IS BIAS 2 


; PHASE ADVANCE LATERAL POSITION 
; ADD IN USER DEMANDS 
; LATERAL GAIN 
; INTEGRATOR 
; STORE LATERAL DEMAND 


; CHANNEL 3 IS BIAS 3 


PHASE ADVANCE YAW ATTITUDE 

ADD IN USER DEMANDS 

YAH GAIN 

INTEGRATOR 

STORE YAH DEMAND 


; CHANNEL 4 IS BIAS 4 


PHASE ADVANCE AXIAL POSITION 

ADD IN USER DEMANDS 

AXIAL GAIN 

INTEGRATOR 

STORE AXIAL DEMAND 


; CHANNEL 5 IS CONTROL 1 


MODEL OUT DETECTOR 


r 

TST 

OUTFLG 

IS 3 0? 


BNE 

MODIN 

JUMP TO OUTPUTS IF NOT 

MODOUTi 

CLR 

VO 

CLEAR ALL FINAL DEMANDS 


CLR 

PO 

IF MODEL IS OUT 


CLR 

LO 



CLR 

YO 



CLR 

AO 



CLR 

VINT 

INCLUDING HIGH ORDER 


CLR 

PINT 

INTEGRATOR ACCUMULATORS 


CLR 

LINT t 


CLR 

YINT 



CLR 

AINT 



CLR 

INTFLG 

[TURN MAIN INTEGRATORS OFF 


CLR 

DRGFLG 

;ALSO DRAG INTEGRATOR 

MODINt 





> 
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/ OUTPUTS WITH 
• 

INTERLEAVED D 

/E/M 1, AFT PORT, OUTPUT 

MOV 

YO,RO 

SUB 

VO,RO 

SUB 

PO,RO 

SUB 

LO,RO 

OUTPUT 

0 

/COLLECT AND START A/D 
ADCLS 

• 

ADST 6 

9 

/E/M 2, FORWARD PORT, OUTPUT 

MOV 

PO,RO 

SUB 

VO,RO 

SUB 

LO,RO 

SUB 

YO,RO 

OUTPUT 

1 

•AFT STARBOARD 

OUTPUT 

MOV 

LO,RO 

SUB 

VO,RO 

SUB 

PO,RO 

SUB 

YO,RO 

OUTPUT 

2 


; COLLECT AND START A/D 
ADCLS 
ADST 7 

f 

; FORWARD STARBOARD OUTPUT 


MOV 

PO,RO 

ADD 

LO,RO 

ADD 

YO,RO 

SUB 

VO,RO 

OUTPUT 

3 

OUTPUT 

MOV 

AO,RO 

0UTPU2 

4 


ACQUISITION 


; FETCH YAW DEMAND 
/ SUBTRACT VERTICAL DEMAND 
; SUBTRACT PITCH DEMAND 
/SUBTRACT LATERAL DEMAND 
;CALL OUTPUT ROUTINE 


; CHANNEL 6 IS CONTROL 2 


?L0AD RO WITH PITCH DEMAND 
/SUBTRACT VERTICAL 
/SUBTRACT LATERAL 
/SUBTRACT YAW 
/CALL OUTPUT ROUTINE 


/LOAD RO WITH LATERAL 
/SUBTRACT VERTICAL 
/SUBTRACT PITCH 
/SUBTRACT YAW 
/CALL OUTPUT ROUTINE 


/CHANNEL 7 IS CONTROL 3 


LOAD RO WITH PITCH 
ADD LATERAL 
ADD YAW 

SUBTRACT VERTICAL 
CALL OUTPUT ROUTINE 


/FETCH AXIAL DEMAND 
/CALL OUTPUT ROUTINE 


/COLLECT A/D AND START NEXT 
ADCLS 
ADST2 0 

9 

/ LOOP RATE INDICATOR FLOP 

r 

FLPFLP 5,-2000 
/COLLECT A/D 

ADCLS2 ; 

r 

; ********* > I '******A**A**A* A A********* AA AA AA A A AA AAAAA**** *********** ************ 
/ PRESERVE DATA ? 


/CHANNEL (2)0 IS CONTROL 4 


/SETS CHANNEL 5 D/A TO +2.5V APPROX. 


TST 

DATFLG 

/IS C SET +VE (STORE) ? 

BEQ 

NOSAMP 

/JUMP OUT IF NO 

DEC 

DATFLG 

/REDUCE CYCLE COUNTER 

TST 

OVRFLW 

/LOOK FOR DATA OVERFLOW 

BEQ 

NOSAMP 

/JUMP OUT IF YES 
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DEC 

OVRFLW 

; REDUCE OVERFLOW COUNTER 



BR 

ENDSMP 

;KEEP DATA AND JUMP OUT 

NOSAMP: 

SUB 

#SAMPLE,SP 

; DISCARD DATA 

ENDSMPs 




•PREPROGRAMMED ROUTINE EXECUTION 


r 


PREPRG 

CHARS, COMMAN 

;CALL PREPROGRAMMED ROUTINE 

•RESTORE SYSTEM 

STACKS, RETURN TO PREVIOUSLY EXECUTING CODE 

JUMPST : 

MOV 

SP,DATA 

; ARCHIVE DATA STACK POINTER 



MOV 

STACK, SP 

; RESTORE SYSTEM STACK 



MOV 

(SP)+,R2 

;POP R2 



MOV 

( SP)+,R1 

;POP R1 



MOV 

(SP)+,RO 

;POP RO 

f 


RTI 


; RETURN TO USERIO FROM INTERRUPT 


; DECLARE VARIABLES 


STACK: 

.WORD 

0 ; 

SYSTEM STACK POINTER 

VO 


.WORD 

0 

VERTICAL CURRENT DEMAND 

PO 


.WORD 

0 

PITCH DEMAND 

LO 


.WORD 

0 

LATERAL DEMAND 

YO 


.WORD 

0 

YAH DEMAND 

AO 


.WORD 

0 

AXIAL DEMAND 

VT 


.FLT2 

0 . , 0 . 

INTERMEDIATE DATA STORAGE 

PT 


• FLT2 

0 . , 0 . 

FOR PHASE ADVANCERS 

LT 


.FLT2 

0 . , 0 . 


YT 


• FLT2 

0 . , 0 . 


AT 


.FLT2 

0 . , 0 . 


VINT: 

.WORD 

0,0 

INTEGRATOR ACCUMULATORS 

PINT: 

.WORD 

0,0 


LINT: 

.WORD 

0,0 


YINT: 

.WORD 

0,0 


AINT: 

.WORD 

0,0 

? 


.END 
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CNTRLB . MAC 


; ********************************************** ****************************** 
; THE MACRO ROUTINES CONTAINED IN THIS LIBRARY ARE AS FOLLOWS : : 


TRANSL X,Y,Z TRANSLATOR/ OSCILLATOR 

ROTATE YAW, PITCH, ROLL ROTATOR/OSCILLATOR 


PHASEF PROGRAMMABLE DUAL PHASE ADVANCE 

INTEG FIXED PARAMETER ERROR INTEGRATOR 

INTEG2 AUXILIARY FIXED PARAMETER (DRAG) INTEGRATOR 


> OUTPUT 

? OUTPU2 


D/A OUTPUT ROUTINE AND OVERFLOW CLAMP 
DRAG D/A OUTPUT ROUTINE 


; ADCL 

i ADCL 2 

; ADCLS 

; ADCLS2 


FETCH READY A/D DATA (BOARD 1) 

FETCH READY A/D DATA (BOARD 2) 

FETCH A/D DATA AND STORE ON STACK (BOARD 1) 
FETCH A/D DATA AND STORE ON STACK (BOARD 2) 


ADST INITIATE A/D CONVERSION (BOARD 1) 

ADST2 INITIATE A/D CONVERSION (BOARD 2) 


TIME1 MARK TIME FROM CLOCK 1 ON STACK 

TIME2 MARK TIME FROM CLOCK 2 ON STACK 

DAST STORE AVAILABLE DATA ON STACK 

PREPRG PREPROGRAMMED ROUTINE EXECUTION 

FLPFLP LOOP RATE INDICATOR FLIP/FLOP 

DIGSCN SCAN DIGITAL INPUT PORTS FOR POSITION DATA 


***************************************************************************** 


FULL TRANSLATOR /OSCILLATOR FOR X,Y,Z; 

Input data In R5, output to R2 

NUM is d-o-f, l=axlal, 2=lateral, 3=vertical 


.MACRO 

TRANSL CHARS, 0SCILL,N1 

SUB 

CHARS+<2*<NUM+127>> ,R5 

SUB 

CHARS + < 2 * < NUM+6 7 > > , R5 

MOV 

CHARS+<2*136>,R1 

MOV 

CHARS+<2*<NUM+121>> ,R2 

MOV 

CHARS+<2*<NUM+110>> ,R3 

MUL 

R3,R1 

ADD 

R2,R1 

BIC 

#176000, R1 

ASL 

R1 

ADD 

OSCILL.Rl 

MOV 

(Rl) ,R2 

MOV 

CHARS+<2*<NUM+100>> ,R4 

MUL 

R4,R2 

NEG 

R2 

ADD 

R5,R2 

.ENDM 

TRANSL 


ADD DC OFFSET TO R5 
AUXILIARY DISPLACEMENT 
GET MASTER COUNTER 
LOAD PHASE 
LOAD FREQUENCY 

INCREMENT COUNTER FOR FREQUENCY 
LOW ORDER PRODUCT ONLY RETAINED 
INCREMENT COUNTER FOR PHASE 
OVERFLOW IGNORED 
REDUCE COUNTER TO 10 BITS 
CONVERT R1 TO WORD ADDRESSING 
ADD OSCILLATOR BASE ADDRESS 
GET RELEVANT OSCILLATOR VALUE 
GET AMPLITUDE 
OSCILLATION AMPLITUDE 
HIGH ORDER PRODUCT USED 
CORRECT SIGN OF OSCILLATOR 
ADD OSCILLATOR TO R5 
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{FULL ROTATOR /OSCILLATOR FOR ROLL /PITCH /YAW 
; Input in R5, output to R2 

; NUM is d-o-f, l=roll, 2=pitch, 3=yaw 


.MACRO ROTATE CHARS, OSCILL, NUM 

; INPUT DATA IN R5 


SUB 

CHARS+<2*<NUM+113>> ,R5 

SUB 

CHARS+<2*<NUM+54>> ,R5 

MOV 

CHARS+<2*136>,R1 

MOV 

CHARS+<2*<NUM+124>> ,R2 

MOV 

CHARS+<2*<NUM+116>> ,R3 

MUL 

R3,R1 

ADD 

R2,R1 

BIC 

#176000, R1 

ASL 

R1 

ADD 

OSCILL, R1 

MOV 

(Rl) ,R2 

MOV 

CHARS+<2*<NUM+103>> ,R4 

MUL 

R4,R2 

NEG 

R2 

ADD 

R5,R2 

.ENDM 

ROTATE 


ADD DC OFFSET TO R5 
AUXILIARY DISPLACEMENT 
GET MASTER COUNTER 
LOAD PHASE 
LOAD FREQUENCY 

INCREMENT COUNTER FOR FREQUENCY 
INCREMENT COUNTER FOR PHASE 
REDUCE COUNTER TO 10 BITS 
CONVERT R1 TO WORD ADDRESSING 
ADD OSCILLATOR BASE ADDRESS 
GET RELEVANT OSCILLATOR VALUE 
GET AMPLITUDE 
OSCILLATION AMPLITUDE 
CORRECT SIGN OF OSCILLATOR 
ADD OSCILLATOR TO R5 
OUTPUT TO R2 


; DUAL PHASE ADVANCER 

; Input data from SOURCE, output to R5 

; Y, Y+4. are intermediate results. LI, L2, GAIN are parameters 

; P0S,NEG, FINISH are local symbols 


.MACRO PHASEF SOURCE, Y,L1,L2, GAIN, ?POS,?NEG,?FINISH 

AC0=*0 ; DEFINE FLOATING POINT REGISTERS 

AC1=*1 

AC2=%2 

AC3*%3 

AC4=%4 

AC5=%5 


; INPUT VALUES L1,L2 CORRESPOND TO : 

; L1=T/ (T+DT) 

; L2=N*T/DT 

; GAIN=10.*( (DT/T)**2) 

\ OVERALL D.C. GAIN * 10 (CONVENIENCE ONLY) 

; AAPROXIMATE VALUES FOR 256 HZ LOOP RATE AND N=10 AS FOLLOWS : 


? T I 

; LI I 

; L2 I 

f GAIN I 


0.007 0.006 

0.64 0.61 

17.9 15.4 

3.11 4.24 


SOURCE, ACO 
#GAIN,AC0 


; GET INPUT VALUE 

LDCIF 
MULF 


0.005 

0.56 

12.8 

6.10 


0.004 0.003 

0.51 0.43 

10.2 7.7 

9.54 16.95 


;ACO=DEMAND POSITION (P) 
{CORRECT GAIN TO 8 OVERALL 
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FIRST PHASE ADVANCE 


LDF Y,AC1 

ADDF AC1 ,ACO 

MOLF #L1 , ACO 

STF ACO,Y 

SUBF ACO ,AC1 

MULF #-L2 ,AC1 

ADDF ACO ,AC1 

SECOND 

LDF Y+4. ,AC2 

ADDF AC2 ,AC1 

MULF #L1 ,AC1 

STF AC1 ,Y+4. 

SUBF AC1,AC2 

MULF #-L2 ,AC2 

ADDF AC1,AC2 

OVERFLOW CLAMPS 


AC1=Y1(K-1) 

AC0=P+Y1 (K-l ) 

AC0=Y1 (K) 

UPDATE Yl(K-l) TO Y1(K) 
AC1=Y1(K-1)-Y1(K) 
AC1=XMY1(K)-Y1(K-1) ) 
AC1=Y2 (K) 


/REPEAT FOR SECOND 


CMPF #16383. ,AC2 


COMPARE TO HALF INTEGER OVERFLOW 

A A A A i*r A A A A A A A A A A A A A AAAA A AAA A A A A A A 


THIS IS AN ARBITRARY VALUE AND 
PROCEDURE AND IS CAPABLE OF 
PRODUCING INCORRECT OR UNPREDICTABLE 
RESULTS WITH UNUSUAL OUTPUT DEMAND 
MIXING 

AAAAAA A A A A A A AA AA AA AAAAAAA A AAAAAA 



CFCC 



COPY CONDITION CODES TO CPU 


BMI 

POS 


BRANCH TO POSITIVE LIMITER 


CMPF 

#-16383 

. ,AC2 

COMPARE TO -HALF INTEGER 


CFCC 



COPY CONDITION CODES 


BPL 

NEG 


BRANCH TO NEGATIVE LIMITER 


STCFI 

AC2 ,R5 


STORE RESULT IN MAIN REGISTER 


BR 

FINISH 


DONE HERE 

POSs 

MOV 

#16383. 

,R5 

POSITIVE LIMITER 


BR 

FINISH 


DONE HERE 

NEG j 

MOV 

#-16383 

. ,R5 

NEGATIVE LIMITER 

FINISH: 






.ENDM 

PHASEF 




STANDARD ERROR INTEGRATOR 

Source data in R2, accumulator is INT, uses "h" as flag 
OFF is local symbol 


. MACRO INTEG CHARS , INT , ?OFF 

MOV INT,R0 

MOV INT+2. ,R1 

TST INTFLG 

BEQ OFF 

MOV R2,R4 

CLR R5 

ASHC #-12, R4 

ADD R5,R1 

ADC RO 


FETCH PRESENT INTEGRATOR ACCUMULATOR 
(HIGH AND LOW WORDS) 

ARE MAIN INTEGRATORS ON? 

JUMP FORWARD IF NO 
STORE POSITION ERROR 

POSITION ERROR * KdT 

ADD PRESENT INTEGRATOR VALUE TO 

INTEGRATOR ACCUMULATOR 
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ADD R4,R0 

OFF* ADD R0,R2 
MOV RO , INT 

MOV R1 , INT+2 . 

.ENDM INTEG 


POSITION ERROR+INTEGRATOR ACCUMULATOR 
RESTORE INTEGRATOR ACCUMULATOR 

INTEGRATORS ARE NOT OVERFLOW LIMITED 



AUXILIARY ERROR INTEGRATOR 

Source data in R2, accumulator is INT, uses "H" as flag 
OFF is local symbol 


. MACRO INTEG2 CHARS , INT , TOFF 
MOV INT,R0 

MOV INT+2., R1 

TST DRGFLG 

BEQ OFF 

MOV R2,R4 

CLR R5 

ASHC #-12,R4 

ADD R5,R1 

ADC RO 

ADD R4 ,RO 

OFF i ADD RO ,R2 
MOV RO , INT 

MOV R1 , INT+2 . 

.ENDM INTEG2 


FETCH PRESENT INTEGRATOR ACCUMULATOR 
(HIGH AND LOW WORDS) 

IS DRAG INTEGRATOR ON? 

JUMP FORWARD IF NO 
STORE POSITION ERROR 

POSITION ERROR * KdT 

ADD PRESENT INTEGRATOR VALUE TO 

INTEGRATOR ACCUMULATOR 

POSITION ERROR+INTEGRATOR ACCUMULATOR 
RESTORE INTEGRATOR ACCUMULATOR 

INTEGRATORS ARE NOT OVERFLOW LIMITED 


; 

/++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 
;D/A OUTPUT ROUTINE AND OVERFLOW CLAMPER 
; Input in RO, output direct to D/A channel 

; NEGCLM, POSCLM, FINISH are local symbols 


.MACRO OUTPUT CHANN,?NEGCLM,?POSCLM,?FINISH 


ZEROI-6000 

ADD #ZEROI ,R0 


BMI NEGCLM 

CMP #7777, RO 

BMI POSCLM 

BR FINISH 

POSCLM: BIS #7777, RO 

BR FINISH 

NEGCLM: BIC #7777, RO 

FINISH: MOV RO , @# < OUT+ < CHANN*2 > > 

.ENDM OUTPUT 


.•NOMINAL ZERO CURRENT D/A VALUE 

; INCLUDE SOFTWARE BIAS FOR D/A 
; 2047. =0 VOLTS 
;LOOK FOR NEGATIVE OVERFLOW 
; BRANCH TO NEGATIVE OVERFLOW CLAMP 
;LOOK FOR POSITIVE OVERFLOW 
; BRANCH TO POSITIVE OVERFLOW CLAMP 
;DONE HERE 

; FORCE POSITIVE CLAMP 
,-DONE HERE 

? FORCE NEGATIVE CLAMP 
; OUTPUT TO D/A 

•DONE 



jD/A OUTPUT ROUTINE AND OVERFLOW CLAMPER 
t Input in RO, output direct to D/A channel 

; NEGCLM, POSCLM, FINISH are local symbols 


; 
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MACRO OUTPU2 CHANN , ?NEGCLM , 7P0SCLM , 7FINISH 



ZERO I 

=4000 

? 

ADD 

#ZEROI ,R0 


BMI 

NEGCLM 


CMP 

#7777 ,R0 


r 

mm 

POSCLM: 

BIS 

#7777, RO 


BR 

FINISH 

NEGCLM: 

BIC 

#7777 ,R0 

FINISH: 

MOV 

RO , 0# < 0UT+ < CHANN*2 > > 


.ENDM OUTPU2 


} NOMINAL ZERO CURRENT D/A VALUE 

INCLUDE SOFTWARE BIAS FOR D/A 
2047. =0 VOLTS 

LOOK FOR NEGATIVE OVERFLOW 
BRANCH TO NEGATIVE OVERFLOW CLAMP 
LOOK FOR POSITIVE OVERFLOW 
BRANCH TO POSITIVE OVERFLOW CLAMP 
DONE HERE 

FORCE POSITIVE CLAMP 
DONE HERE 

FORCE NEGATIVE CLAMP 
OUTPUT TO D/A 

DONE 


+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 
A/D BOARD 1 CONVERSION READY TEST AND DATA COLLECT 

Data from A/D board 1, placed in DEST 
TEST is local symbol 


.MACRO ADCL DEST,?TEST 

TEST: TSTB 0#AD1SR 

BPL TEST 

MOV 0#AD1BR,DEST 


IS A/D DONE? 

WAIT IF NO 

STORE INPUT DATA (CLEARS DONE BIT) 


.ENDM ADCL 


;+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 
; A/D BOARD 2 CONVERSION READY TEST AND DATA COLLECT 
; Data from A/D board 2, placed in DEST 

; TEST is local symbol 


TEST: 


.MACRO ADCL2 DEST,?TEST 

TSTB 0#AD2SR 

BPL TEST 

MOV 0#AD2BR,DEST 


IS A/D DONE? 

WAIT IF NO 

STORE INPUT DATA (CLEARS DONE BIT) 


.ENDM ADCL2 


A/D BOARD 1 COLLECT ROUTINE FOR DATA ACQUISITION 

Data from A/D board 1, placed on stack 
TEST2 is a local symbol 


.MACRO ADCLS ?TEST2 

SAMPLE=SAMPLE+2 
TEST2 : TSTB 0#AD1SR 

BPL TEST2 

MOV 0#AD1BR , ( SP ) + 


; INCREMENT DATA COUNTER 
; IS A/D DONE ? 

?WAIT IF NO 

;PUSH DATA ON STACK (CLEARS DONE BIT) 


.ENDM ADCLS 
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I++++++++++++++4-++++++++++++++++++4-++++++++-M-++++++++++++++++.I.++4-+++++++++++++ 

;A/D BOARD 2 COLLECT ROUTINE FOR DATA ACQUISITION 
; Data from A/D board 2, placed on stack 

; TEST2 is a local symbol 


.MACRO ADCLS2 7TEST2 

SAMPLE = SAMPLE* 2 
TEST2 : TSTB 0#AD2SR 

BPL TEST2 

MOV 0#AD2BR , ( SP ) + 


. ENDM ADCLS2 


; INCREMENT DATA COUNTER 
; IS A/D DONE ? 

;WAIT IF NO 

;PUSH DATA ON STACK (CLEARS DONE BIT) 


•+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 
i START DATA ACQUISITION ON BOARD 1 
; CHANN is channel address (0-8) 


.MACRO ADST CHANN 

MOV #< <CHANNM00> 1 1> ,0#AD1SR ; INITIATE A/D CONVERSION 

.ENDM ADST 


9 

; START DATA ACQUISITION ON BOARD 2 
; CHANN is channel address (0-8) 


.MACRO ADST2 CHANN 

MOV #< <CHANN*400> 1 1> ,0#AD2SR ; INITIATE A/D CONVERSION 

.ENDM ADST2 


++++++++++++-M-+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 

TIME MARK FROM CLOCK 1 

Push time on stack 


.MACRO TIME 

SAMPLE=SAMPLE+2 ; INCREMENT DATA COUNTER 

MOV 0#CL1B, (SP)+ ;PUSH TIME ON STACK, INC SP 

.ENDM TIME 


9 

,++ 4 -++++ 4 -+++++++++ 4 -+++++++++++++++++++++ 4 -+++++++++++++++++++++++++++++++++++++ 

;TIME MARK FROM CLOCK 2 
; Push time on stack 


.MACRO TIME2 

SAMPLE-SAMPLE+2 ; INCREMENT DATA COUNTER 

MOV 0#CL2B, (SP)+ jPUSH TIME ON STACK, INC SP 

.ENDM TIME 


J.4..J.+4..M.-M.-M.++++++.+++++++++++++++++++++++++++++-M-++++++++++++++++++++++++++++++ 

;DATA STORE 
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Push SOURCE data on stack 


.MACRO DAST SOURCE 

SAMPLE= S AMPLE+ 2 ; INCREMENT DATA COUNTER 

MOV SOURCE, (SP)+ ;PUSH DATA ON STACK , INCREMENT SP 

. ENDM DAST 

r 

• 

r 

;+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 
; PREPROGRAMMED ROUTINE EXECUTION 

; CHARS and COMMAN arrays are accessed 

; AUTO, NOAUTO, AUTCOM, AUTEND are local symbols 


.MACRO PREPRG CHARS, COMMAN, ?AUTO , 7N0AUT0 , 7AUTC0M . 7AUTEND 


AUTO: 

TST 

CHARS+<2*107> 


BEQ 

NOAUTO 


TST 

CHARS+<2*134> 


BNE 

AUTCOM 


MOV 

COMMAN, RO 


MOV 

(R0)+,CHARS+< 2*134 > 


BEQ 

AUTEND 


MOV 

(R0)+,R1 


MOV 

(R0)+,R2 


MOV 

R1 , CHARS (R2) 


MOV 

RO, COMMAN 

• 

BR 

NOAUTO 

AUTCOM: 

DEC 

CHARS+<2*134> 


BR 

NOAUTO 

AUTEND: 

DEC 

CHARS+<2*107> 


MOV 

<COMMAN+2> ,R0 

NOAUTO: 

MOV 

RO, COMMAN 

w 

.ENDM 

PREPRG 


IS AUTO ROUTINE CONTROL PARAMETER 
(G) SET POSITIVE? 

JUMP OUT IF NOT 

IS THIS AUTO COMMAND COMPLETED? 

JUMP OUT IF NOT 

LOAD POINTER TO THIS COMMAND DURATION 

LOAD THIS COMMAND DURATION 

JUMP IF THIS IS THE TERMINATOR 

FETCH AUTO COMMAND VALUE 

FETCH INSTRUCTION CODE 

DEPOSIT COMMAND VALUE WHERE REQUIRED 

UPDATE COMMAND POINTER 

DONE HERE 

DECREMENT DELAY COUNTER 
DONE HERE 

DECREMENT (CLEAR) AUTO COMMAND FLAG 
RESTORE COMMAND POINTER 


; 


+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 
LOOP RATE INDICATOR FLIP/FLOP ROUTINE 

Preset VALUE Is passed to specified D/A CHANNel 


.MACRO FLPFLP CHANN, VALUE 

MOV #<VALUE+4000> ,@#<0UT+<CHANN*2> > ; OUTPUT VALUE TO D/A 
.ENDM FLPFLP 

r 

9 

;+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 
f DIGITAL INPUT PORT SCAN FOR POSITION DATA 


Input 

port assignments 

as 

follows: 

Bits 


Port 

Channel Sensor 

0-9 


A 

1 

AL 

10-15 

+ 

A 



0-3 


B 

2 

AX 

4-13 


B 

3 

AU 

14-15 

+ 

B 
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0-7 C 4 FU 

8-15 + C 

0-1 D 5 FL 

Outputs direct to AL, FU etc. 


.MACRO DIGSCN 

MOV @#DBRA,R3 ; FETCH DIGITAL INPUT PORT DATA 

MOV . 0#DBRB,R2 { 

MOV 8#DBRC,R1 ; 

MOV @#DBRD,R0 ; 

♦ 

; DISASSEMBLE FOR INDIVIDUAL CHANNELS 


MOV 

R3,R4 

•COPY PORT A 

BIC 

#176000, R4 

;MASK HIGH BITS 

MOV 

R4,AL 

* 

9 

MOV 

R3,R5 

•COPY PORT A 

MOV 

R2,R4 

;AND PORT B 

ASHC 

#-10., R4 

{JUSTIFY DATA 

BIC 

#176000, R5 

{MASK HIGH BITS 

MOV 

R5,AX 

♦ 

9 

MOV 

R2,R4 

{COPY PORT B 

ASH 

#-4. ,R4 

{JUSTIFY DATA 

BIC 

#176000, R4 

{MASK HIGH BITS 

MOV 

R4,AU 

» 

r 

MOV 

R2,R5 

{COPY PORT B 

MOV 

R1.R4 

{AND PORT C 

ASHC 

#-14. ,R4 

{JUSTIFY DATA 

BIC 

#176000, R5 

{MASK HIGH BITS 

MOV 

R5,FU 

1 

MOV 

R0,R4 

{COPY PORT D 

MOV 

R1,R5 

{AND PORT C 

ASHC 

#-8. ,R4 

{JUSTIFY DATA 

BIC 

#176000, R5 

{MASK HIGH BITS 

MOV 

R5,FL 

♦ 

9 

.ENDM 

DIGSCN 
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CONFIG. MAC 


f aaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaa 


; 


THE MACRO ROUTINES CONTAINED IN THIS LIBRARY ARE AS FOLLOWS 


; CONFIG SYSTEM I/O ADDRESS CONFIGURATION 

; DFCHAR CHARS ARRAY DEFINITIONS 

} 

• A*AA*A*****A**A**AAA*****AAA***A*AA***AA*AA***AA*A**AAA)kA****AAA*A*AA***AAA*A 

»+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 
; SYSTEM CONFIGURATION - Defines all hardware addresses, vectors etc. No 
} run- tine content 




.MACRO CONFIG 


; 

; PROGRAMMABLE CLOCKS 


CL1S*170400 

; CLOCK 

1 

CLlB=CLlS+2 

; CLOCK 

1 

CL1V=440 

,• CLOCK 

1 

CL2S-170420 

; CLOCK 

2 

CL2B-CL2S+2 

; CLOCK 

2 

CL2V-450 

; CLOCK 

2 


S TATUS REGISTER 
BUFFER /PRESET REGISTER 
INTERRUPT VECTOR 

STATUS REGISTER 
BUFFER/PRESET REGISTER 
INTERRUPT VECTOR 


; A/D CONVERTERS 


AD1SR=170430 

ADlBR=ADlSR+2 

AD2SR=170440 

AD2BR=AD2SR+2 


; A/D BOARD 1 
; A/D BOARD 1 

; A/D BOARD 2 
; A/D BOARD 2 


STATUS REGISTER 
DATA/ BUFFER REGISTER 

STATUS REGISTER 
DATA/ BUFFER REGISTER 


D/A CONVERTERS 

0UT=170450 


; DIGITAL I/O PORTS 

; 

CSRA=164160 

DBRA=CSRA+2 

CSRB=CSRA+4 

DBRB=CSRA+6 

CSRC=CSRA+10 

DBRC=CSRA+12 

CSRD=CSRA+14 

DBRD*CSRA+16 

• 

? KEYBOARD/CRT 

TKS=177560 

TKB=TKS+2 

• 

TPS=TKS+4 

TPB=TKS+6 

; SYSTEM FUNCTIONS 


; FIRST D/A PORT (CHANNEL 0, BOARD 1) 

; FOLLOWING CHANNELS IN INCREMENTS OF 2 
;LAST CHANNEL IS 13 (OCTAL, BOARD 3), =170476 


PORT A STATUS REGISTER 

PORT A DATA/ BUFFER REGISTER 

PORT B STATUS 

PORT B DATA 

PORT C STATUS 

PORT C DATA 

PORT D STATUS 

PORT D DATA 


; KEYBOARD STATUS REGISTER 
; KEYBOARD DATA/ BUFFER REGISTER 

;CRT STATUS REGISTER 
;CRT DATA/ BUFFER REGISTER 


LCLK=177546 


; SYSTEM (LINE FREQUENCY) CLOCK 
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PSW-177776 {PROCESSOR STATUS WORD 

. ENDM CONFIG 



;CHARS ARRAY DEFINITIONS - Sets default assignments of key variables to CHARS 
{ array locations. All are GLOBAL references 


.MACRO DFCHAR 

• POS ITI ONS / ATTITUDES 

AXIAL— jCHARS+ 14 
LAT== : CHARS+1 6 
VERT== :CHARS+20 
PITCH** iCHARS+24 
YAW* * : CHARS+26 

{ 

{ LOOP GAINS 

• 

AG--:CHARS+102 
LG* *: CHARS+1 04 
VG== : CHARS+1 06 
PG=* : CHARS+1 12 
YG* = : CHARS+1 14 

* 

{ POSITIONS SENSORS 
{ 

AL=*s CHARS 
AX*= sCHARS+2 
AU**:CHARS+4 
FU=* : CHARS+6 
FL*= : CHARS+1 0 

{ PROGRAM SWITCHES 
{ 

DATFLG** s CHARS+< 2*73 > 
OVRFLW** : CHARS+< 2*17> 
OUTFLG== ; CHARS+< 2*75> 
INTFLG=*:CHARS+<2*110> 
DRGFLG==:CHARS+<2*50> 
AUTFLG-* ; CHARS+< 2*107 > 
AUTNUM** sCHARS+<2*47> 

{ MISCELLANEOUS 

0SC*= :CHARS+<2*136> 

; 

.ENDM DFCHAR 


AXIAL POSITION 
LATERAL POSITION 
VERTICAL POSITION 
PITCH ATTITUDE 
YAW ATTITUDE 


AXIAL GAIN 
LATERAL GAIN 
VERTICAL GAIN 
PITCH GAIN 
YAW GAIN 


POSITION SENSOR SIGNALS 
AL=AFT LEFT, 

FU= FORWARD UPPER, 

ETC. 


DATA ACQUISITION FLAG ("C") 
DATA OVERFLOW FLAG ( “ / “ ) 
OUTPUT ON/ OFF FLAG ( " 1 ") 
MAIN INTEGRATOR FLAG ( “h" ) 
DRAG INTEGRATOR FLAG < H H M > 
AUTO ROUTINE FLAG ( M g M ) 
AUTO ROUTINE NUMBER ( “G" > 


{OSCILLATOR MASTER COUNTER 
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APPENDIX C -PDP 11/23 SYSTEM CONFIGURATION 


CPU - PDP 11/23 PLUS with FPF11 floating point processor 

Operating system - RT11 V5.0 

Languages - FORTRAN V2.6, MACRO V5 . 0 

User I/O devices - VT102 CRT, LAIOO printer, HP7475 plotter 

Real-time I/O - 16/32 A/D channels (differential/single ended) 

12 D/A channels 
64 digital I/O lines 

Clocks - 2 programmable 

Serial I/O - 6 lines (console, printer, plotter, 3 spare) 

Memory - 256kB (only 56kB normally available for real-time 

software) 


SYSTEM CONFIGURATION and MODULE SPECIFICATION 


SYSTEM SERIAL NUMBER - BT02952 DEC - 84065849X 


11/23 BE - System box 


Module 

Etch/rev 

Function 

Address 

Vector 

M8189 

C 

A 

11/23 CPU 



M8188 

C 

C 

FPF-11 floating point 



M8067 

C 

A 

MSV11 memory 



M8061 

C 

C 

RLV22 disk controller 



M8377 



KXT11-C processor 

160100 


M4002 

J 

M 

KWV11-C clock 

170400 

440 

M4002 



KWV11-C clock 

170420 

450 

M8043 

E 

M 

DLV11-J serial I/O 

176500 

300 





510 

310 





520 

320 





530 

330 

M9404 



Bus extender 



BA11-SE 

expansion 

box 



M9405 



Bus extender 



A8000 

E 

H 

ADV11-C A/D 

170430 

400 

A8000 



ADV11-C A/D 

170440 

420 

A6006 

E 

F 

AAV11-C D/A 

170450 


A6006 

E 

F 

AAV11-C D/A 

460 


A6006 



AAV11-C D/A 

470 


M8049 



DRV11-J Digital I/O 

164160 

Prog. 
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Serial line baud rates are: 


RT11 unit 1 

Console 

Printer 

9600 

9600 

2 

SLU1 

300 

3 

SLU2 (plotter) 

9600 

4 

SLU3 

9600 

5 

SLU4 

9600 
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APPENDIX D 


Individual hardware subsystems can be tested and exercised 
to some degree without the MSBS operating and without the 
controller software running. Such procedures are frequently 
necessary for isolation of hardware or software malfunctions. 


Position sensors 


"TSTDIO" scans the digital input ports and decodes the input 
data to position sensor counts, following the same procedures 
documented in the controller module "CNTRLB" (APPENDIX 2) . The 
position sensor "backup" clock or the computer clock must be 
running in order to generate valid sensor outputs. "TSTDIO" does 
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Current monitors 


"TSTAD1" and "TSTAD2" scan all input channels to A/D boards 
1 and 2 respectively. The usual channel assignments (see Section 
3) are summarized below: 

Board Computer channel External channel Function 


1 0 

1 
2 

3 

4 

5 

6 
7 

2 0 


1 

2 

3 

4 

5 

6 

7 

8 
9 


Drag current 
Bias 1 
Bias 2 
Bias 3 
Bias 4 
Control 1 
Control 2 
Control 3 
Control 4 


The numbering sequence for electromagnets is shown below. A/D 
voltage ranges are liable to be changed between 0 to +10V and 
-10V to +10V. Consult PDP-11 system documentation for further 
details. 



Electromagnet numbering sequence 


Power supplies 

"TSTOUT" can be used to set the D/A outputs to any desired 
steady-state level, thereby commanding steady currents from the 
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(Control) electromagnet power supplies. Normal channel 
assignments are shown below : 

D/A board Computer channel External channel Function 


10 1 

1 2 

2 3 

3 4 

(2) 4 (sequential) (or 0) 5 


Control 1 
Control 2 
Control 3 
Control 4 
Drag 


The D/A converters will normally be set to the following ranges: 


Counts Range point 


Nominal voltage 


0 

4000 

7777 


+Full scale 
0 V 

-Full scale 


+10 V 
0 V 
-10 V 



TSTDIO. FOR 


qaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaa 
C PROGRAM TO SHEEP TEST MSBS POSITION SENSOR DIGITAL CHANNELS 

0AA*AAAAAAA*AAA*Aik***AA**AAAAA*AA*A*AA****AAA**A*AAA*****AA*AA*AAA*AA**A*AAAAA 

c 

C SCANS DIGITAL INPUT PORTS ASYNCHRONOUSLY, DECODES TO POSITION SENSOR COUNTS 
C OUTPUT IS POSITION SENSOR COUNTS (DECIMAL) FOR SENSOR CHANNELS 1-5 IN 
C COLUMNS 1-5. 

C 

C ** WARNING ** ASYNCHRONOUS SCAN TECHNIQUE CAN GIVE INVALID DATA DURING 
C INPUT PORT UPDATING. 

C 

DIMENSION IDATA( 5 ) 

TYPE 10 

10 FORMAT (' DIGITAL INPUT (POSITION SENSOR) SWEEP TEST') 

TYPE 20 

20 FORMAT ( ' NUMBER OF SWEEPS?') 

READ( 5,*) NSWEEP 
50 DO 30 1*1, NSWEEP 

CALL DIOTST(IDATA) 

30 TYPE 40, ( IDATA( J) , J*1 ,5) 

40 F0RMAT(5I8) 

PAUSE 
GO TO 50 
STOP 
END 



DIOTST.MAC 


.TITLE DIOTST 


Input port assignments as follows: 

Bits Port Channel Sensor 

0-9 A 1 AL 

10-15 + A 

0-3 B 2 AX 

4-13 B 3 AU 

14-15 + B 

0-7 C 4 FU 

8-15 + C 

0-1 D 5 FL 


.GL0BL DIOTST 

; 

CSRA=164160 

DBRA*CSRA+2 

CSRB-CSRA+4 

DBRB-CSRA+6 

CSRC=CSRA+10 

DBRC-CSRA+12 

CSRD*CSRA+14 

DBRD-CSRA+16 

• 

CLS-170420 

CLB-CLS+2 

DIOTST: TST (R5)+ 

MOV (R5)+,DATA 


DIGITAL PORT A STA TUS 
PORT A DATA BUFFER 
PORT B STATUS 
ETC. 


? CLOCK NO. 2 STATUS REGISTER 
i CLOCK NO. 2 BUFFER REGISTER 

;SKIP ARGUMENT COUNT 

;SAVE ARRAY ADDRESS FOR DATA RETURN 


MOV 0#DBRA,R3 

MOV @#DBRB,R2 

MOV 0#DBRC,R1 

MOV Q#DBRD,R0 

DISASSEMBLE FOR INDIVIDUAL CHANNELS 

MOV R3 ,R4 

BIC #176000 ,R4 

MOV R4.0DATA 

ADD #2, DATA 

MOV R3 ,R5 

MOV R2 ,R4 

ASHC #-10., R4 

BIC #176000, R5 

MOV R5,0DATA 

ADD #2, DATA 

MOV R2,R4 

ASH #-4 . ,R4 

BIC #176000, R4 

MOV R4,0DATA 

ADD #2, DATA 

MOV R2,R5 

MOV R1,R4 

ASHC #-14.,R4 

BIC #176000, R5 

MOV R5,0DATA 


FETCH DIGITAL INPUT PORT DATA 


COPY PORT A 
MASK HIGH BITS 
STORE 

INCREMENT STORE ADDRESS 

COPY PORT A 
AND PORT B 
JUSTIFY DATA 
MASK HIGH BITS 
STORE 

INCREMENT STORE ADDRESS 

COPY PORT B 
JUSTIFY DATA 
MASK HIGH BITS 
STORE 

INCREMENT STORE ADDRESS 

COPY PORT B 
AND PORT C 
JUSTIFY DATA 
MASK HIGH BITS 
STORE 
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ADD 

#2, DATA 

f 

MOV 

R0,R4 


MOV 

R1,R5 


ASHC 

#-8. ,R4 


BIC 

#176000, R5 


MOV 

R5,0DATA 

; 

ADD 

#2 .DATA 

RTS 

PC 

DATA* 

.WORD 

0 

f 

.END 



; INCREMENT STORE ADDRESS 

;COPY PORT D 
;AND PORT C 
; JUSTIFY DATA 
;MASK HIGH BITS 
; STORE 

; INCREMENT STORE ADDRESS 
;GO BACK TO FORTRAN 
;DATA ARRAY ADDRESS STORAGE 
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TSTAD1 . FOR 


CAAAAAAAAAAAAA^AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 
C PROGRAM TO SWEEP TEST A/D CONVERTER BOARD 1 

QAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

c 

C REPETITIVELY SCANS ALL (8) CHANNELS OF A/D BOARD 1 IN OCTAL OR DECIMAL FORM 
C REQUESTED CYCLES OVER 1000 CAUSES CONTINUOUS SWEEPING UNTIL <CONTROL>C 
C OUTPUT IS DATA FROM CHANNELS 0-7 IN COLUMNS 1-8 
C 



DIMENSION IDATAQ6) 
TYPE 10 

10 

FORMAT ( ' A/D BOARD 1 SWEEP TEST' ) 
TYPE 20 

20 

FORMAT ( / ' NUMBER OF CYCLES? (>1000 CONTINUOUS)') 
READ(5,M ICYCLE 

24 

TYPE 25 

25 

£ 

FORMAT ( ' OCTAL(O), OR DECIHAL(l) OUTPUT?') 
READ (5,*) IDUMMY 
IF (IDUMMY) 24,100,200 

C OCTAL 

P 

OUTPUT 

100 

JCYCLE-1 

30 

DO 40 ICHANN*0,7 

40 

CALL AD1TST( ICHANN, IDATA( ICHANN+1 ) ) 
TYPE 50, ( IDATA( J) , J*1 ,8) 

50 

FORMAT (808) 

IF ( JCYCLE. GT. ICYCLE) GO TO 60 
J CYCLE* J CYCLE+ 1 
GO TO 30 

60 

IF ( ICYCLE. GT. 1000) GO TO 30 

PAUSE 

GO TO 100 


C 

C DECIMAL OUTPUT 
C 

200 JCYCLE® 1 

130 DO 140 ICHANN=0,7 

140 CALL AD1TST( ICHANN , IDATA( ICHANN+1 ) ) 

TYPE 150, < IDATA( J) , J=l,8) 

150 FORMAT (817) 

IF ( JCYCLE . GT . ICYCLE ) GO TO 160 
JCYCLE* JCYCLE+1 
GO TO 130 

160 IF ( ICYCLE. GT. 1000) GO TO 130 

PAUSE 
GO TO 200 
END 
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AD1TST . MAC 



.TITLE 

AD1TST 

; PROGRAM TITLE 

f 

.GLOBL 

AD1TST 

; GLOBAL SYMBOL 

9 

ADSR*170430 

; DEFINE A/D COMMUNICATIONS 


ADBR*ADSR+2 

; PORTS 

AD1TST: 

TST 

(R5) + 

;SKIP ARGUMENT COUNT 


MOV 

(R5)+,CHANN 

;GET ADDRESS OF CHANNEL NUMBER 


MOV 

(R5)+,DATA 

»SAVE ADDRESS LOCATION FOR DATA 

9 

MOV 

0CHANN,RO 

; FETCH CHANNEL NUMBER 


ASH 

#8 . ,R0 

; SHIFT NUMBER TO BITS 8-11 


BIS 

#1 ,R0 

;SET GAIN (1) AND START BIT 


MOV 

RO,0#ADSR 

;SET UP CHANNEL AND GAIN 

9 

TESTt 

TSTB 

0#ADSR 

;IS A/D DONE? 


BPL 

TEST 

;WAIT IF NOT 


TST 

RO 

; DUMMY WAIT 


MOV 

0#ADBR,RO 

i FETCH DATA 


MOV 

RO ,0DATA 

; AND STORE 

i 

RTS 

PC 

;GO BACK TO FORTRAN 

CHANNi 

.NORD 

0 

; CHANNEL NUMBER 

DATA i 

!end 

.WORD 

0 

; RETURNED DATA 
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TSTAD2 . FOR 


CAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAiIiAAAiIiAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 
C PROGRAM TO SWEEP TEST A/D CONVERTER BOARD 2 

CAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

c 

C REPETITIVELY SCANS ALL (8) CHANNELS OF A/D BOARD 2 IN OCTAL OR DECIMAL FORM 
C REQUESTED CYCLES OVER 1000 CAUSES CONTINUOUS SWEEPING UNTIL <CONTROL>C 
C OUTPUT IS DATA FROM CHANNELS 0-7 IS COLUMNS 1-8 
C 

DIMENSION IDATA( 16) 

TYPE 10 

10 FORMAT ( ' A/D BOARD 2 SWEEP TEST' ) 

TYPE 20 

20 FORMAT ( / ' NUMBER OF CYCLES? (>1000 CONTINUOUS)') 

READ( 5,*) ICYCLE 

24 TYPE 25 

25 FORMAT ( ' OCTAL(O), OR DECIMAL(l) OUTPUT?') 

READ ( 5 ,* ) IDUMMY 

IF (IDUMMY) 24,100,200 
C 

C OCTAL OUTPUT 
C 

100 JCYCLE=1 

30 DO 40 ICHANN=0,7 

40 CALL AD2TST ( ICHANN , IDATA ( ICHANN+1 ) ) 

TYPE 50, ( IDATA(J) ,J=1,8) 

50 FORMAT (808) 

IF (JCYCLE.GT. ICYCLE) GO TO 60 

JCYCLE=JCYCLE+1 

GO TO 30 

60 IF ( ICYCLE. GT. 1000) GO TO 30 

PAUSE 
GO TO 100 
C 

C DECIMAL OUTPUT 
C 

200 JCYCLE=1 

130 DO 140 ICHANN=0 ,7 

140 CALL AD2TST ( ICHANN , IDATA ( ICHANN+1 ) ) 

TYPE 150, ( IDATA( J) ,J=1,8) 

150 FORMAT( 817 ) 

IF (JCYCLE.GT. ICYCLE) GO TO 160 

JCYCLE=JCYCLE+1 

GO TO 130 

160 IF ( ICYCLE. GT. 1000) GO TO 130 

PAUSE 
GO TO 200 
END 
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AD2TST.MAC 



.TITLE 

AD2TST 

t PROGRAM TITLE 

r 

.GLOBL 

AD2TST 

; GLOBAL SYMBOL 

; 

ADSR* 170440 

{DEFINE A/D COMMUNICATIONS 


ADBR=ADSR+2 

,-PORTS 

; 

AD2TST: 

TST 

(R5) + 

{SKIP ARGUMENT COUNT 

MOV 

<R5)+,CHANN 

{GET ADDRESS OF CHANNEL NUMBER 


MOV 

(R5)+,DATA 

{SAVE ADDRESS LOCATION FOR DATA 


MOV 

9CHANN.R0 

{FETCH CHANNEL NUMBER 


ASH 

#8. ,R0 

{SHIFT NUMBER TO BITS 8-11 


BIS 

#1 ,RO 

{SET GAIN (1) AND START BIT 


MOV 

RO , 0#ADSR 

{SET UP CHANNEL AND GAIN 

TEST: 

TSTB 

9#ADSR 

{IS A/D DONE? 


BPL 

TEST 

{WAIT IF NOT 


TST 

RO 

{DUMMY WAIT 


MOV 

0#ADBR,RO 

{FETCH DATA 


MOV 

RO.0DATA 

{AND STORE 

; 

RTS 

PC 

{GO BACK TO FORTRAN 

CHANNs 

.HORO 

0 

{CHANNEL NUMBER 

DATA: 

» 

!end 

.WORD 

0 

{RETURNED DATA 


0-15) 

RETURN 
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TSTOUT . FOR 


CAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAil'AAAAAAAAAAAAAAAi't 
C PROGRAM TO TEST D/A CONVERTER FUNCTION 

CAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

c 

C TAKES (DECIMAL) CHANNEL NUMBER AND (OCTAL OR VOLTAGE) DATA AND SETS 
C RELEVANT D/A CHANNEL. PRESENT VALID CHANNEL NUMBERS ARE 0-11, VALID DATA 
C IS FROM 0-7777 (OCTAL), OR -10 TO +10 (VOLTS) 

C 

C 0 * +FULL SCALE (9.9951V) 

C 4000 » OV 

C 7777 - -FULL SCALE (-10V) 

C 

C NEGATIVE CHANNEL NUMBER OR < CONTROL >C ABORTS PROGRAM 
C OUTPUT IS OLD (OCTAL) D/A PORT DATA, NEW (OCTAL) DATA, CHANNEL NUMBER 
C (DECIMAL) AND NOMINAL D/A OUTPUT VOLTAGE 
C 

100 TYPE 10 

10 FORMAT ( * D/A SINGLE CHANNEL TEST'//,' SPECIFY OCTAL(O) OR VOLTS(l) 

1 INPUT') 

READ(5,M IDUMMY 
20 TYPE 30 

30 FORMAT ( / ' CHANNEL NUMBER (DECIMAL, 0-11)?') 

READ(5,*) ICHANN 
IF( ICHANN.LT. 0 ) GO TO 70 
IF( ICHANN.GT.il) GO TO 20 
IF (IDUMMY) 100,110,120 
C 

C OCTAL INPUT SECTION 
C 

110 TYPE 40 

40 FORMAT ( ' DATA (OCTAL, 0-7777)?') 

READ(5,50,ERR=20) IDATA2 
50 FORMAT (04) 

IF ( IDATA2 .LT. O.OR. IDATA2.GT. ”7777 ) GO TO 110 
CALL OUTTST ( ICHANN , IDATA1 , IDATA2 ) 

EQVOLT=-10 . * ( IDATA2- "4000 ) / FLOAT ( " 3777 ) 

TYPE 6 0 , IDATA1 , IDATA2 , ICHANN , EQ VOLT 
60 FORMAT ( ' OLD DATA* ' ,06 , ' NEW DATA* ' , 06 , ' CHANNEL* ' , 14 , 

1 ' NOMINAL VOLTS*' ,F7. 3) 

GO TO 20 
C 

C VOLTAGE INPUT SECTION 
C 

120 TYPE 130 

130 FORMAT ( ' DATA (VOLTAGE, -10 TO +10)?') 

READ(5,+) VOLTS 

IF (ABS(VOLTS) .GT.10) GO TO 120 
IDATA2=IFIX( "4000- "3777*VOLTS*0 . 1 ) 

CALL OUTTST ( ICHANN , IDATA1 , IDATA2 ) 

TYPE 8 0 , IDATA1 , IDATA2 , ICHANN , VOLTS 
80 FORMAT ( ' OLD DATA*' ,06, ' , NEW DATA*' ,06, ' CHANNEL*' ,14, 

1 ' NOMINAL VOLTS*' ,F7. 3) 

GO TO 20 
C 

C DONE 
C 

70 STOP 

END 
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OUTTST . MAC 



.TITLE 

OUTTST 

; PROGRAM TITLE 

i 

. GLOBL 

OUTTST 

; DECLARE GLOBAL SYMBOL 

r 

DAONE-170450 

; ADDRESS OF FIRST D/A CONVERTER 

r 

OUTTST j 

TST 

(R5)+ 

;SAVE DATA ACROSS FORTRAN CALL 


MOV 

(R5)+ ,CHANN 

; CHANNEL NUMBER 


MOV 

(R5)+,DATA1 

;FOR OLD DATA 


MOV 

<R5)+,DATA2 

;NEW DATA 

i 

MOV 

3CHANN.R0 

; FETCH CHANNEL NUMBER 


ASL 

RO 

; CONVERT TO CHANNEL ADDRESS INCREMENTS 


MOV 

#DAONE,Rl 

; FETCH BASE ADDRESS 


ADD 

R1 ,R0 

;ADD BASE 

} 

MOV 

(R0),8DATA1 

; FETCH THE CURRENT D/A BUFFER CONTENTS 


MOV 

3DATA2 , (RO ) 

; WRITE IN THE NEM VALUE 

• 

RTS 

PC 

;GO BACK TO FORTRAN 

CHANNs 

.WORD 

0 

; CHANNEL NUMBER 

DATA1 i 

.WORD 

0 

;D/A BUFFER DATA BEFORE WRITE 

DATA2: 

.WORD 

0 

;NEW D/A BUFFER DATA 

i 

.END 
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